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1.0 EXECUTIVE SUMMARY 

The Optical Multi-Access (OMA) Terminal is capable of establishing up to six 
simultaneous high-data-rate communication links between low-Earth-orbit satellites 
and a host satellite at synchronous orbit with only one 16-inch-diameter antenna on 
the synchronous satellite. The advantage over equivalent RF systems in space 
weight, power, and swept volume is great when applied to NASA satellite 
communications networks (Figure 1-1). 

Figure 1-2 is a photo of the 3-channel prototype constructed under the present 
contract to demonstrate the feasibility of the concept. The telescope has a 10-inch 
clear aperture and a 22° full field of view. It consists of 4 refractive elements 
to achieve a telecentric focus, i.e., the focused beam is normal to the focal plane 
at all field angles. This feature permits image pick-up optics in the focal plane 
to track satellite images without tilting their optic axes to accommodate field 
angle. Figure 1-3 shows the geometry of the image-pick-up concept, and Figure 1-4 
shows the coordinate system of the swinging arm and disk mechanism for image 
pick-up. Optics in the arm relay the telescope focus to a communications and 
tracking receiver and introduce the transmitted beacon beam on a path collinear with 
the receive path. The electronic circuits for the communications and tracking 
receivers are contained on the arm and disk assemblies and relay signals to an 
associated PC-based operator’s console for control of the arm and disk motor drive 
through a flexible cable which permits ±240° travel for each arm and disk assembly. 
Power supplies and laser transmitters are mounted in the cradle for the telescope. 
A single-mode fiber in the cable is used to carry the laser transmitter signal to 
the arm optics. Figure 1-5 shows the promise of the optical multi-access terminal 
towards which the prototype effort worked. The emphasis in the prototype 
development was the demonstration of the unique aspects of the concept, and where 
possible, cost avoidance compromises were implemented in areas already proven on 
other programs. 

The design details are described in Section 2, the prototype test results in Section 
3, additional development required in Section 4, and conclusions in Section 5. 
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FIGURE 1-2 
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DISK AND ARM ROTATION SYSTEM 




FIGURE 1-4 

I ROTATES ± 60 ° 

ARM ATTACHED TO DISK 

SIX DISK ASSEMBLIES SPACED VERTICALLY SERVE SIX CHANNELS 


GOALS OF BASELINE MULTI-ACCESS TERMINAL 


• SIMULTANEOUS COMMUNICATION WITH SIX INDEPENDENT 
ASYNCHRONOUS LINKS 

• FULL COVERAGE OF EARTH AND LOW ORBITS 

• LIGHT WEIGHT (=150 POUNDS) 

• SMALL SIZE (10-INCH-DIAMETER CLEAR APERTURE) 

• LOW POWER (<100 WATTS) 

• LOW SWEPT VOLUME (NO GIMBALS) 

• 3 MBPS PER COMM LINK (CONCEPT SUPPORTS HIGHER RATE) 

• 10 KBPS FORWARD RATE PER LINK 
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2.0 DESIGN OVERVIEW 

2.1 Optical 

2.1.1 Telescope - The telescope elements are shown in Figure 2.1-1 for the space 
design. Radiation hardened glass is specified for long life in space. Figure 2.1-2 
and -3 show the spot diagram at the focal plane for various off-axis positions with 
a 300-^m circle for reference. This diameter represents 480 ^rad in the far 
field of the system. Figure 2.1-4 depicts the plastic design used in the prototype 
to save cost. This material is unsuitable for space due to darkening effects of 
radiation but provides comparable optical performance for demonstration in the 
laboratory. Figure 2.1-5 compares the space and prototype designs. Appendix A 
contains the detailed lens specifications for both the glass and plastic designs. 

2.1.2 Focal-plane optics - Figure 2.1-6 shows the arrangement of optics for the 
space design. The figure is arranged with the arms aligned one over the other in a 
vertical plane and show the locations of the channels with respect to the telescope 
focal plane. The receive channels are designed to relay the focus to the quadrant 
detector through a narrow-band optical filter for transmitter rejection. The trans- 
mitter signals are introduced by means of a single-mode fiber whose image is formed 
at the telescope image plane and coaligned with the arm receiver optical axis. The 
beamwidth is 150 fi rad FWHM, so the image is 94 ^m, FWHM. Because the tele- 
scope forms a telecentric image, the arms need only be located at the correct spot 
to receive the light, and no tilt of the optic axis as a function of field angle is 
required. In the prototype we included Channel 1, a channel between 2 and 3, and 
Channel 4, renamed Channels 1, 2, and 3, respectively. Figure 2.1-7 is a photograph 
of a complete arm for Channel 3 fully assembled with optics and electronics. 


2.2 Mechanical 

2.2.1 Disk and arm assemblies - The arm is mounted on a 354-tooth worm-gear ring 
and attached to a second worm-gear ring. Moving the two rings together moves the 
arm pivot point through more than one complete revolution, while differential 
movement of the rings with respect to each other swings the arm on its pivot. 
Therefore, by driving the worm on each ring (or "disk", as we have referred to them 
previously) to the proper location, any point in the field of the telescope can be 
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addressed. Figure 2.2-1 shows the geometry of the field and the arm and disk 
angles. For each location in the field, there are two possible orientations of the 
arm and disk. If a low-Earth-orbit satellite passes directly through or very near 
the center of the field, there will be a short outage while the disks swing 180° to 
pick up the signal on the other side of center. These outages will be rare and are 
readily predicted well in advance. 

The worm assembly is shown in Figure 2.2-2. The worm is captive between preloaded 
bearings with no contribution to backlash. The assembly is spring-loaded into the 
worm gear to minimize backlash in the disk drive. The motors are of two types. 
Channel 1 is driven by two MicroMo 3557CR motors with up to 8.5 in-oz of continuous 
torque. The other two channels are driven by MicroMo 2842 motors with 3 in-oz of 
torque. The two different types of motors were used to ensure adequate torque 
margin on at least one channel, while exploring the possible savings in size and 
weight of the smaller motor. Position feedback for each motor is provided by a 
Hewlett-Packard HEDS 5010 2000-count-per-revolution incremental optical shaft 
encoder. 

The 3-channel structure is shown in cross-section in Figure 2.2-3 showing the 
"sandwich" construction of the disk assembly. A photo showing the baseplate with 
the motor amd worm interfaces is presented in Figure 2.2-4. Figure 2.2-5 gives the 
mechanical constants for the arm and disk mechanical design. 

23 Acquisition and Tracking Design Constraints 

The approach for acquisition is simple and straightforward. Spacecraft attitude 
reference, ephemeris, and mounting uncertainties require that a square 3.5 
milliradians on a side be searched at the GEO. Table 2.3-1 presents the analysis of 
this requirement. The LEO will stare at its uncertainty region and respond as soon 
as it is illuminated by slewing its narrow transmit beam to reduce the error 
measured by means of the received signal from the GEO. Consequently, if the GEO 
will dwell at a given location for a time sufficient for the signal to reach the LEO 
(1 transit time), the LEO to slew to boresight (say, 30 milliseconds), and return 
its optical signal (1 transit time), then before it moved to the next scan location, 
it would know to stop where it is and track. Figure 2.3-1 shows the resulting worst 
case acquisition times given 100% probability of detection when illumination occurs. 
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FIGURE 2.2-1 ARM AND DISK COORDINATES IN THE TELESCOPE FIELD OF VIEW 



- 14 - 











CABLE DhUMS 



j 

! 


j 

i 




\ 


I 

I 

i 


t 


< 



DRAWING NUMBER 






MULTI-ACCESS FREE SPACE LASER COMMUNICATIONS TERMINAL - FINAL REPORT 


DISK/ARM RESOLUTION 

CONTINUOUS MOTOR/WORM DRIVE IMPLEMENTATION 

GEAR TEETH PER REVOLUTION 

24 PITCH ON 14.75-INCH DIAMETER 354 

WORM DRIVE ENCODER RESOLUTION 2000 

DISK STEP RESOLUTION 2^/354/2000 = 8.87 //RAD 

CORRESPONDING MOTION AT EDGE OF 116-MM FOCAL PLANE 

8.87/i RAD x 1 1 6mm 1 .03 //m 

CORRESPONDING FAR-FIELD ANGLE 

1 .03 //m/.625m (FOCAL LENGTH) .64 //RAD 

FOR D4/D3 = 2.56 

ARM STEP ANGULAR RESOLUTION 

8.87 //RAD x 2.56 22.7 //RAD 

LINEAR MOTION AT TIP OF ARM 

22.7 u RAD x ARM LENGTH (167mm) 3.79 //m 

CORRESPONDING FAR-FIELD ANGLE 

3.79/zm/.625m 6.07 //RAD 

FIGURE 2.2-5 
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2.4 Electronics 


Figure 2.4-1 presents an overall block diagram of the electronics showing where the 
various circuits are housed. The computer contains the motor control electronics on 
a special internal expansion card that plugs into the computer bus. The power 
supplies, limit-switch relay circuits, and computer interface connectors are mounted 
in the cradle that supports the telescope and its focal-plane optics assemblies. 
The quadrant-detector receiver circuits are mounted in the arm assemblies themselves 
and connect to angle-processing circuitry mounted on the disk assemblies. 
Connection to the computer from each arm is made via the cradle-mounted circuitiy 
through a flexible cable which permits ±240° travel of each arm. 

Summary descriptions of the electronic assemblies are presented below. Detailed 
schematics of all circuits are contained in Appendix B. 

2.4.1 Motion control circuitiy - Figure 2.4-2 is a block diagram of the motion- 
control chip used for control of the motors driving the worm-gear assemblies. The 
performance of the compensation loop is controlled by downloading the desired gain, 
cycle time, and digital transfer function parameters. 

The overall control loop is shown in Figure 2.4-3. This diagram incorporates the 
functions of the HCTL-1000 motor-control chip, the motor drive amplifier, the 
quadrant detector and its angle processor, and the computer control algorithms for 
open- and closed-loop control of the arm position for each channel. The design of 
the control loop sought to achieve a 4-Hertz control bandwidth, supported by a 
40-Hertz update rate for each channel by the computer. Figure 2.4-4 shows the 

design Bode plots for the open- and closed-loop motor control transfer functions for 
a 4-Hertz control loop. 

Motion control circuit board - This board contains six Hewlett-Packard HCTL-1000 
chips and the associated interface circuitry. This chip accepts input position 
commands, incremental encoder outputs, and mode-control and loop-compensation 
parameters and develops the appropriate motor drive word for D/A conversion and 
amplification. Other circuitry performs multiplexing of the computer bus among the 
various motor-control chips and output word conversion. 
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MOTOR CONTROLLER CHIP BLOCK DIAGRAM 

HEWLETT-PACKARD HCTL-1100 


LIMIT STOP PROF INI T 
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FIGURE 2.4-3 
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Limit-s witch relay circuit board - Each of the three channels has four limit 
switches to sense the positive and negative limits of motion for the disk pair and 
for the arm. These switches operate relays which prevent current flow in the 
appropriate motor in the appropriate direction to prevent further motion in the 
offending direction but which permit motion in the opposite direction. Encoder 
outputs and motor drive signals are routed through this board, which is mounted in 
the cradle assembly. Figure 2.4-5 shows the arrangement for Channel 2. Channels 1 
and 3 are similar except that the power amplifiers are not required for the smaller 
motors used on those channels. 

Quadrant detector preamplifier - Two stages of preamplification are utilized to 
detect a 5 kHz tone on the received optical signal incident on the four segments of 
the quadrant detector. The stages are AC coupled and rolled off above 6 kHz to 
eliminate DC drifts and high frequency components in of the communications data 
signal. A low-noise operational preamplifier, OP-470, and post amplifier, OP-471, 
from PMI are used for this purpose. See Figure 2.4-6. 

Digital angle processor - The Analog Devices ADSP-2101 is a digital signal processor 
utilized to process samples of the four quadrants to produce a measure of the 
position of the centroid of the optical signal focused on the quadrant detector. 
The familiar horizontal and vertical difference-over-sum functions of the four 
quadrant signals, A, B, C, and D, are given by 

<5 V =(A+B-C-D)/(A+B+C+D) 

<5 h =(A+C-B-D)/(A+B+C+D) 

The processor computes the numerators of the above expressions in addition to the 
more demanding task of extracting the amplitude of the 5-kHz tone from the composite 
data and tone signal. Figure 2.4-7 illustrates the signal waveform. The amplitude 
of the basic Manchester pulse train is modulated with the 5-kHz tone to a depth of 
10%. The preamps described above perform some initial processing by attenuating the 
components at the data frequency. The resulting 5-kHz signal is sampled at 27.18 
kHz by a 4-channel A-to-D converter which simultaneously samples and holds the 4 
quadrant signals then sequentially converts them for use by the processor. The 
processor passes 100 such samples for each quadrant through a 40-tap bandpass 
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RECEIVER WAVEFORM SHOWING DATA AND TONE 



maximum extinction ratio = P3/P2 = 0.1 14 
tone modulation depth = 1 - P2/P1 - 0 125 
peak data power P2 - P3 = t.5 x measured average power 


FIGURE 2.4-7 
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digital filter, a rectifier, and a 40-tap low-pass to extract the amplitude of the 
tone. These four values are then used in the above equations to produce the 
vertical and horizontal position components. The entire process requires 4.2 
milliseconds and has a latency of about 7.8 milliseconds, i.e., the data used to 
control the motors is about 7.8 milliseconds old when the resulting control is 
applied. The circuit configuration is presented in Figure 2.4-8. The software for 
this processor is described in the software section. 

2.4.2 Communications circuits - The quadrant detector bias current is modulated 
by the total optical signal incident on the detector and contains the wideband data 
signal. Figure 2.4-9 shows the wideband amplifier used to detect the data component 
of the optical signal. The TIEF151 amplifiers have 40-MHz bandwidth and a 
transimpedance gain of 4 kilohm. The arrangement utilize here achieves a 
closed-loop bandwidth 3 MHz to support the 3 Mbps receive-channel design data rate. 
Higher bandwidth is achievable with the detector used given the required amplifier 
design and packaging developments. 

The transmitted optical signal serves as a tracking beacon to the low-Earth-orbit 
(LEO) satellite and provides low-rate data capability for command, control, and 
housekeeping functions. Figure 2.4-10 presents the circuit to drive an SDL-5301 
laser diode to impose a 5-kHz. tone and 100-kHz. data signal on the optical beam. 
Adjustments for the diode slope efficiency and threshold characteristics to achieve 
the desired depth of modulation for the tone are provided. These circuits are 
mounted in the cradle area with the laser diodes they drive, and the optical signal 
is fed to the arm optics in each case by means of a single-mode fiber. 

2.5 Software 

Executive control of the terminal is provided by a CompuAdd 325 personal computer 
with a math co-processor. The motor control processor described above receives its 
operating parameters and mode control instructions from the executive while the 
angle processors, triggered by a sync-pulse generator, acquire the latest tracking 
errors. Overall synchronization of the executive, motor-control, and angle 
processors is accomplished by the sync-pulse generator. This software is described 
in this section. Detailed listings with comments are contained in Appendix C. 
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2.5.1 Executive - There are three main executive programs for operation of the 
terminal: MANUAL. C, TRACK.C, and OMA.FOR. The first two programs, written using 
Microsoft Quick C are used for real-time control of the terminal when operated in 
the manual or automatic mode, respectively. In addition, there is a Fortran 
executive, OMA.FOR, which calls the other Fortran programs to exercise a simulation 
of the system, and which represents an initial version of satellite operational 
executive software. The Fortran and C programs are compiled into MS-DOS-executable 
files to perform the complete job of operating the terminal in the modes required. 

M anual Operation Software - Table 2.5-1 illustrates the make-up of the manual 
MS-DOS-executable file, MANUAL.EXE. As seen from the table, these programs are writ- 
ten entirely in C. Their functions are accessed from the main menu, presented in 
Table 2.5-2. These functions permit open-loop exercising of the disk and arm actua- 
tors for the three channels. For example, initial calibration of the position refer- 
ences for all channels can be accomplished with Option 6, Channel Alignment. This 
action is required only if a disk has been moved by hand either with the power off 
or with neither MANUAL.EXE nor TRACK.EXE running. Arm and disk motion to specific 
locations can be accomplished with Options 1 and 2. Exercising channels to trouble- 
shoot or validate mechanical operation can be accomplished with Options 3 and 4. 
Various tests of the motion-control electronics can be performed with Options 7-14. 

Operational Satellite Software - The operational satellite software is illustrated 
by Figure 2.5-1, which diagrams the interaction of the various Fortran modules of 
the control software for an operational system. Where arrows indicate hardware 
interfaces, this software simulates the hardware when necessary to complete an 
action in the simulation mode. This organization was developed during the design 
phase of this project in order to understand the constraints imposed by the 
satellite and the mission. The modifications required to interface with and operate 
the prototype terminal preserve this organization to the maximum extent possible. 
They are discussed in Paragraph 2.5.4. 

Table 2.5-3 illustrates the make-up of OMA.EXE from source code files written in 
Fortran. Each terminal interface module is sensitive to a REALTIME discrete to 
determine whether it simulates the inputs it needs or gets them from a hardware 
source. Therefore the programs are useful for simulation studies and also contain 
the switches to permit interfacing with actual hardware. 


- 34 - 




MULTI-ACCESS FREE SPACE LASER COMMUNICATIONS TERMINAL - FINAL REPORT 

TABLE 2.5-1 MANUAL OPERATION SOFTWARE ORGANIZATION 

Modules called by MANUAL.C to make up MANUAL.EXE 


MODULE FILE 

COMPUTE.C 

DISCRETE.C* 

DISPLAY.C 

FILE.C* 

INITMOT.C 

MOTCNT.C* 

MOTOR.C* 

NEWMOT.C 

SERL.C* 


FUNCTION 

Subroutines to convert among az/el, alpha/delta, and 
delta A/B coordinates. 

Subroutines to monitor the status of all the discretes in 
the system. 

Subroutines to generate the menu for the manual 
operation. 

Subroutines to open and close all files, read and write 
system and test data. 

Initializes motion control digital parameters. 

Subroutines for mechanical alignment of the system. 
Subroutines for direct interfacing with the motor-control 
circuit board in the computer. 

Subroutines for controlling the motion of the disks. 
Subroutines for communication over RS-232 links from the 
PC to the channel angle processors or to another PC. 


*Also used in the automatic mode presented in Table 2.5-3. 


TABLE 2.5-2 MANUAL CONTROL MENU 


* Move Channel Commands * 

1. Move optics arm delta & alpha increment 

2. Move arm to designated Az and El 

3. Exercise single channel through limits 

4. Exercise all channels through limits 

5. Compute channel Az & El 

* Alignment Command * 

6. Channel alignment 

* System Test Commands * 

7. Motor safety switch test 

8. DSP to PC serial link test 

9. Host PC to Monitoring PC serial link test 

10. Power monitoring discrete test 

11. Motor drive backlash test 

12. Motor step response test 

13. Channel eccentricity test 

14. Reset Motor Command 
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TABLE 2.5-3 OPERATIONAL SATELLITE SOFTWARE ORGANIZATION 

Modules called by OMA.FOR or by each other to make up OMA.EXE 


MODULE FILE CALLED BY 


FUNCTION 


ALDLDLAB.FOR 

ANGLPR.FOR 

ARKTNS.FOR 

AZELALDL.FOR 

CNTRLFN.FOR 

COPYVEC.FOR 

CROSS.FOR 

DFG.FOR 

DOT.FOR 

ELSTAT.FOR 

GAUSCL.FOR 

GAUSS.FOR 

INV3X3.FOR 

NAVIGFN.FOR 

NAVIGPR.FOR 

QFITVAL 

RNDM.FOR 

RUK.FOR 

SCANGN.FOR 

SCENEPR.FOR 

TRUTHGN.FOR 

UNIT.FOR 

VLEN.FOR 

XKEP.FOR 

XYAZEL.FOR 


CNTRLFN.FOR 

CNTRLFN.FOR 

ANGLEPR.FOR 

ASGNMFN.FOR 

ASGNMFN.FOR 

TRUTHGEN.FOR 

XYAZEL.FOR 

RUK.FOR 

ANGLEPR.FOR 

OMA.FOR 

ANGLEPR.FOR 

GAUSCL.FOR 

QFITVAL.FOR 

OMA.FOR 

NAVIGFN.FOR 

TRUTHGEN.FOR 

SCENEPR.FOR 

TRUTHGEN.FOR 

CNTRLFN.FOR 

TRUTHGEN.FOR 

NAVIGFN.FOR 

XYAZEL.FOR 

UNIT.FOR 

ELSTAT.FOR 

SCENEPR.FOR 

ASGNMFN.FOR 


Converts alpha/delta to disk A/B coord. 
Simulates angle processor in sim. mode. 

Takes arctan of arguments in 4 quadrants. 
Converts az/el to alpha/delta coordinates. 
Provides the arm/disk position commands. 
Copies a vector to a new name. 

Performs vector cross product mathematics. 
Satellite state differential equations 
Performs vector dot product mathematics. 
Converts orbital to Cartesian coordinates 
Generates random numbers from clipped 
Gaussian distribution. 

Generates random numbers from Gaussian 
distribution. 

Inverts a 3x3 matrix 

Performs the navigation function 

Adds ephemeris errors to true pos. and vel. 

Quadratic time fit for pos. and vel. 

Generates random numbers for noise sim. 
Fourth order Runge-Kutta integrator. 

Scan generator for acquisition/ 
reacquisition functions 
Computes az/el for each LEO beam. 
Simulates satellite orbital dynamics 
Converts vector to unit vector. 

Computes the length of a vector. 

Solves Kepler’s orbital equation. 

Converts from Cartesian to OMA FOV coord. 
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Real-time Aut omatic Operation Software - The software of the previous section was 
modified to permit operation with the prototype hardware in a laboratory 
environment. The satellite trajectory information is replaced with an initial point 
for acquisition of a signal to be tracked. No effort was made to produce a 
trajectory in the test equipment that could be acquired by open-loop pointing at any 
point in the trajectory similar to acquiring a satellite. The sophistication, 
complexity, and cost of such elaborate test equipment was beyond the scope of this 
effort. Instead, the acquisition program scans a region known to intersect the 
trajectory of the test source so that when the source approaches it can be 
acquired. Table 2.5-4 illustrates the make-up of TRACK.EXE from source code files 
written in both C and Fortran. The Fortran portion controls the automatic 
acquisition and tracking functions while the C portion sets up the initial 
conditions and handles all system-level interfaces. 


TABLE 2.5-4 AUTOMATIC REAL-TIME OPERATION SOFTWARE ORGANIZATION 

Modules called by TRACK.C or by each other to make up TRACK.EXE 


MODULE FILE CALLED BY 


FUNCTION 


MENU.C 
Other C files 
ARKTNS.FOR 

AZELALDL.FOR 

ANGLPR.FOR 

ASGNMFN.FOR 

ASGNMFNR 

BLKDATA.FOR 

CNTRLFN.FOR 

DISCPOS.FOR 

DOT.FOR 

GAUSCL.FOR 


Subroutines to generate the menu for the automatic operation. 

O r T_ i_ 1 _ r i o nn i i ^ ^ r 


See Table 2.5-1 
ANGLEPR.FOR 

ASGNMFNR 

CNTRLFN.FOR 

CNTRLFN.FOR 

INIT 

(sub) 

Compiler 

ASGNMFN.FOR 

CNTRLFN.FOR 

ANGLEPR.FOR 

ANGLEPR.FOR 


See Table 2.5-1 
Takes Arctangent of arguments in 4 
quadrants. 

Converts az/el to alpha/delta coordinates. 

Accesses real-time angle processor output. 
Selects the channel and solution for 
assignment to a LEO beam 
Global constants collected in one file. 

Provides the arm/disk position commands. 
Accesses disk positions saved in C 
programs. 

Performs vector dot product mathematics. 
Generates random numbers from clipped 
Gaussian distribution. 


GAUSS.FOR GAUSCL.FOR 

INTRFACE.FOR TRACK.C 
INIT (sub) 

POSITION (sub) 

SCANGN.FOR CNTRLFN.FOR 


Generates random numbers from clipped 
Gaussian distribution. 

Interface between executive and Fortran. 
Initializes control software. 

Computes new disk position commands. 

Scan generator for acquisition/ 
reacquisition functions 
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2.5.2 Angle Processor Software - The Analog Devices ADSP-2101 digital signal 
processor was programmed to extract the 5-kHz components from each of the 4 quadrant 
signals, then produce the horizontal and vertical coordinates of the centroid of the 
spot by sums and differences as described in Paragraph 2.4.1. The system was set up 
to sample each quadrant at 27.18 kHz for 100 samples and process these samples in an 
algorithm described by Figure 2.5-2. The files which make up this set of algorithms 
are listed in Table 2.5-5. 


TABLE 2.5-5 ANGLE PROCESSOR ROUTINES 


MODULE FILE CALLED BY 


FUNCTION 


ADASYS.DSP 

ALGORTHM.DSP 

BANDFILT.DSP 

LOWPASS.DSP 

MAIN.DSP 

UART.DSP 


MAIN.DSP 

MAIN.DSP 

ALGORTHM.DSP 

ALGORTHM.DSP 

On power-up 

MAIN.DSP 


Contains all routines for sampling data. 
Computes the un-normalized tracking error. 
Code for bandpass filter in Figure 2.5-2. 

Code for low-pass filter in Figure 2.5-2. 
Executive software for angle processor. 
Routine for formatting and sending data to 
host PC. 


2.53 Motion Processor Software - The HP HCTL-1000 has built-in software to 
implement the functions illustrated in Figure 2.4-2. The executive is programmed to 
load the appropriate parameter values into the processor to effect the desired 
digital filtering characteristic and controls the modes of the device in the 
real-time operation of the system. 
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3.0 EVALUATION TEST DATA 

Prior to delivery of the system to NASA Goddard, as part of the integration process 
we performed some evaluation tests on the system and its components. More extensive 
testing could guide the continuing development of an operational terminal by 
providing concrete results to design improvements economically before applying them 
to the next-generation hardware. 

3.1 Optical Tests 

3.1.1 Telescope Performance - The telescope transmission was evaluated using a 
HeNe laser at 6328 A to be 67%. There are 4 lenses with two surfaces each for a 
total of 8 surfaces each apparently transmitting about 95% of the incident energy . 
The performance at the operational wavelength should have been better since the AR 
coating would be superior nearer the operational wavelength. The space system 
should be capable of significantly better performance with superior space coatings. 

It was noted that near but not at the focus, the spot shape to the naked eye had a 
triangular shape that suggested distortion of the lens shape by the 6-point mounting 
hardware. We determined which lens of the set of four was misshapen by rotating 
each lens with respect to the remaining three and observing the orientation of the 
triangle before and after each such rotation. The spot rotated with the rotation of 
the frontmost element, i.e., the lens furthest from the focal plane, suggesting that 
it alone was distorted. We conclude from this test that (1) the mounting rings for 
both the front pair and the back pair should have more fasteners around each ring to 
equalize the clamping around the periphery of the lens, and (2) the interface 
between the two lenses in each pair should be a part machined to the correct shape 
rather than a flexible O-ring. This modification prevents the pair to be clamped in 
a distorted manner. It is possible but unlikely that the part was distorted in 
manufacturing. The nature of the distortion is not characteristic of manufacturing 
errors, which would be axisymmetric rather than triangular. The spot shape suggests 
a lens bent by externally applied force either from mishandling or asymmetrical 
clamping in the mounting bracketry. Because the ring had 6 equally spaced clamping 
bolts, it is reasonable that it could cause a distortion with three-fold symmetry, 
so as to produce a triangular spot. This aberration did not severely affect the 
focussed spot size based on the observations of spot shape on the detector given in 
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the next section. 

3.1.2 Arm Performance - The arm optics were tested for transmission and for 
quadrant detector position transfer function. The transmissions were measured prior 
to assembly into the disk assembly at 65%, 61%, and 55% for Channels 1, 2, and 3, 
respectively. Figure 3.1-1 & -2 shows the quadrant processing characteristic for 
motion along one axis for Channel 3. These data were obtained prior to installation 
of the arm in the system. Note the S-shaped characteristic in the horizontal axis 
and the slight tilt in the vertical axis. This result shows a slight rotation of 
the detector about the optic axis. This error was corrected prior to installation 
and is presented to show the value of these tests. 

The spot shape on the detector was inferred from scans of the arm past the test 
sources. Figure 3.1-3 shows a typical such scan using Channel 1 and diode #2 on a 
three-source test fixture. The derivative of the power on the detector versus 
position is a measure of the shape of the spot in the direction of the scan. Note 
that the focussed spot is twin-lobed due to the laser’s characteristics but that the 
resolving power of the optical system is on the order of 100 microns. 

3.2 Mechanical Tests 

The mechanisms for the disks were tested and run in during assembly to remove 
roughness and minor imperfections in order to ensure smooth operation. Upon 
completion of assembly, tests for resolution, backlash, hysteresis and slew rate 
were performed. Tests to determine that the lighter motors are adequate to drive 
the worm assemblies when sufficiently preloaded to eliminate backlash were 
performed. 

3.2.1 Resolution/backlash/hysteresis - Figures 3.2-1 and -2 show the role of the 
worm assembly adjustment mechanism of Figure 2.2-2. The "Displacement" and 
"Command" refer to the rotation of a single disk. Initial tests showed that the 
path traversed by the mechanism was very different depending on the direction of 
travel. After adjusting the worm into the worm gear, the hysteresis was 
significantly reduced and the current in the motors increased from .25 amps to .5 
amps - still well within capacity. In an operational design, improved design and 
machining approaches would be considered to reduce friction and backlash, including 
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SPOT SHAPE MEASUREMENT 

- Channel 1 with Test Aid Diode 2 - 


MULTI-ACCESS FREE SPACE LASER COMMUNICATIONS TERMINAL - FINAL REPORT 


13A31 1VNOIS dO 3AI±VAId3Q 



H3A3T 1VN0IS 


-45- 


ACROSS-ARM MOTION (MM) 





HYSTERESIS PLOT 
- Before Adjustment - 


MULTI-ACCESS FREE SPACE LASER COMMUNICATIONS TERMINAL - FINAL REPORT 



(aVHOUOIIN) !N3W30V1dSIQ 


I 

rS 

u 

a 


-46- 


COMMAND (MICRORAD) 










MULTI-ACCESS FREE SPACE LASER COMMUNICATIONS TERMINAL - FINAL REPORT 

the use of a split, spring-loaded worm which could act as an anti-backlash gear. 
Additional development of this assembly is recommended in order to improve the 
automatic tracking performance. The steps required appear to be straightforward 
extensions of the present work - not great departures from the current design. 

Backlash tests were performed on each arm in each axis. Figure 3.2-3 shows a scan 
which swung the arm across a spot from a test source, then back again. This test 
was performed with the complete assembly, and, therefore, includes the effects of 
both the telescope and arm optics. Note that the retrace is displaced about 120 
microns from the first trace, indicating a similar amount of backlash in the 
mechanism. The quadrant data displays some amount of cross-coupling, but the motion 
is predominantly in u - the cross-arm axis of the detector. The amount of 
backlash observed is more than is tolerable and could have been significantly 
reduced on disassembly and readjustment for optimum performance. Figure 3.2-4 shows 
another spot shape scan derived from the same data as for the backlash test. The 

spot shape is different because of the difference in channel optics and in location 
in the field. 

3.2.2 Slewing rate - The motor control chip accepts maximum values for velocity 
and acceleration which result in what are referred to as "trapezoidal " moves. The 
name derives from a plot of speed versus time for a point-to-point move. The speed 
increases linearly at the maximum acceleration until the maximum velocity is 
reached, then stays constant until close to the terminus of the move, when the speed 
decreases linearly at the maximum deceleration, and the motor position arrives at 
the terminus as the speed reaches zero. The computations for this move are 
accomplished by the motor control chip, which also issues the commands to accomplish 
the move. Figure 3.2-5 shows a step response of the motors which compares the 
response of the large and small motors under various conditions after initial 
assembly. The small motors were having trouble reacting fast enough when required 
to work against the other disk or move the arm. We disassembled the set-up and 
carefully cleaned out any residual machining debris caught in the lubricant with the 
initial run in and re-ran the test. The result in Figure 3.2-6 revealed that (1) 
the large motor was not hindered by the additional friction due to its higher torque 

capability, and (2) the small motor can provide adequate response under all 
circumstances when properly prepared. 
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FIGURE 3.2-6 
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The slewing rate in the far field is a complex function of the trajectory across the 
field. The most significant occurrence of maximum velocity is when the satellite 
being tracked passes through the center of the field of view. In the limiting case 
an outage occurs until the disks can swing through 180° and pick up the signal on 
the other side of center. We designed for 10° per second and tested 11.4° per 
second and 7.7° per second, depending on what hexidecimal number was loaded into the 
chip for maximum velocity. For the prototype we utilized the slower rate to avoid a 
potential problem overrunning the limit switches on initial calibration. In the 
space system, the maximum slew rate can be set up to at least 30° per second, 
resulting in a maximum outage time of 6 seconds for those extreme cases passing 
directly through the center of the field of view. When another channel is 
available, hand-off could occur to avoid any appreciable outage. Additional testing 
would reveal the maximum reasonable value for the slew rate so that we could 
determine under what circumstances the complexity of the hand-off solution would be 
superior to the brute-force technique of operating at maximum slew rate. 

33 Acquisition Time - The primary parameters which make up acquisition time - 
slew rate, scan pattern, the delay inserted to allow for round-trip optical signal 
propagation - were either verified or are self-evident. The statistical 
characteristics of the process having to do with signal fluctuations at the 
threshold of detectability were beyond the scope of this exercise, but have been 
explored extensively elsewhere. We feel that the estimates of acquisition time 
provided in the design rational are conservative. 

3.4 Tracking Error - Figure 3.4-1 & -2 shows the tracking error for a stationary 
target taken on both the across-arm and the along-arm components. The backlash 
caused some rumble in the motion which is illustrated by the cross-arm component. 
Further experimentation with the mechanical adjustments and worm/worm gear interface 
should reduce this effect and result in a smoother, quieter operation. 

3.5 Weight Analysis - Table 3.5-1 presents a weight analysis of the space design 
as compared to the implementation of the prototype. We conclude that the 150-pound 
goal weight is feasible when lightweighting is utilized in the structural design. 
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MULTIPLE-ACCESS TERMINAL WEIGHT ANALYSIS 

SUBASSEMBLY WEIGHT (LBS) COMMENTS 
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4.0 AREAS FOR FURTHER DEVELOPMENT 

The design, development, assembly and testing of the OMA prototype model demonstra- 
ted the feasibility of the basic concept and its advantages. A number of issues 
became clear as to what is needed to enable the OMA to reach its full potential and 
to be useful space hardware. The following paragraphs discuss these issues. 


First, the telescope used in the OMA was necessarily composed of plastic lenses due 
to cost considerations. This approach adequately demonstrated the concept, but in 
space, special glass must be used to avoid radiation darkening and to avoid cold- 
flow shape changes when in space for long periods. We accomplished a glass design 
to ensure that the same wide field of view can be achieved. In fact, the telescope 
performance in terms of spot diameters in the focal plane will be better in glass, 
and this will help tracking performance. Any next step in development must include 
glass lenses in order to properly evaluate the terminal performance capability. 

Second, custom arm optics are required to achieve the vertical spacing required of 
the six-channel space design. The three-channel prototype design was accomplished 
with standard optics. Small custom optics allow less depth, less arm width to 
reduce channel interference possibilities, and overall lighter weight. The next 
development should include at least one custom optics arm to illustrate the space 
design capability. 


Third, more effort is needed to improve the backlash from the gearing which will 
smooth out the tracking from some peak errors that accrue. These errors are still 
within the error budget but cause noise and make the ratio of peak tracking error to 
rms tracking much greater than it needs to be. The trade-off between less backlash 
and more friction torque can be efficiently made using the prototype as a tool. 
Time and money limits prevented further attention in this effort. 

Fourth, the tracking bandwidth probably should be raised from 40FIz to about 60Hz to 
further improve the tracking performance. 


Effort should be given to ensuring the optical transmission efficiency and needed 
performance is obtained on both transmit and receive. On transmit, the proper 
beamwidth of the transmitter should be established, and any minor optical design 
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changes or hardware adjustments to achieve required performance should be 
accomplished. The receiver optics in the arm would benefit from careful measurement 
for transmission efficiency, image quality, and field of view and adjustment to 
optimize the output. 

The above discussion covers the major areas for further development. The potential 
and demonstrated advantages of the OMA terminal can be fully realized with a 
development model based on the achievements of this program and incorporation of the 
improvements discussed here. 

5.0 CONCLUSIONS 

The OMA prototype represents a first step towards operational multi-access optical 
communications terminal development. The concept was shown to be feasible in a 
low-cost demonstration program which points the way to improvements for operational 
implementation. The basic design is sound and would benefit from a second program 
which would provide a thoroughgoing evaluation of the prototype implementation from 
an optical, mechanical, and electronic viewpoint as a lead-in to a six-channel 
engineering model. This evaluation program would quantify the performance 
capability of the present implementation and identify where design improvements are 
necessary to meet space system requirements and where the present design is 
adequate. This information would guide the next phase toward activities which are 
most cost-effective in achieving the space design. 

The Phase II program was successful in that a prototype was delivered that 
demonstrated the key aspects and special advantages of this unique approach to 
simultaneous multi-access operation. The program showed that the basic advantages 
of size, weight, power, and Earth-viewing swept volume are realizable. They are 
substantial when compared to RF implementations or to separate optical 
transceivers. A patent has been granted for the concept. 

The ability of user satellites to have small-size optical transceivers to work with 
the multi-access terminal is attractive because of the reduced burden on the user 
satellite. It is recommended that communications applications involving wide 
bandwidth simultaneously from various satellites to a relay satellite seriously 
consider this approach as a significantly cost-effective technical solution. 
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APPENDIX A 


TELESCOPE OPTICAL DESIGN SPECIFICATIONS 


Telescope Elements with Ray Trace 

Ray Trace and Surface Curvature Specifications 

Sag Calculations for Individual Elements 
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LDT NASA TELESCOPE AT 1060 NM WAVELENGTH 

File Idtplas 11:08:00 02-14-1991 

ZOOM POSITION 1 
EFL = 627.483 





0 

.001060 

0.000860 

0.001060 



# 

TYPE 

CURVE 

SEPN 

INDEX1 

INDEX2 

INDEX3 

DISPN 

CLRAD 

GLASS 

1 

S 

0 . 000000 

0.000 

1 . 00000 

1.00000 

1 . 00000 

0.00000 

125.61 


2 

A 

0.002135 

400.000 

1.00000 

1.00000 

1.00000 

0.00000 

195.34 


3 

S 

0.003544 

12.700 

1 . 57182 

1 . 57597 

1 . 57182- 

-0 . 00415 

190 . 58 

POLYST 

4 

A 

0.004324 

1 . 000 

1 . 00000 

1 . 00000 

1.00000 

0.00000 

193.87 


5 

S 

0.000633 

81.524 

1.48222 

1.48466 

1.48222- 

-0.00245 

193.08 

ACRYLC 

6 

A 

0.006593 

543.944 

1.00000 

1.00000 

1 . 00000 

0.00000 

170.50 


7 

S 

0.002784 

102.098 

1.48222 

1.48466 

1.48222- 

-0.00245 

164.06 

ACRYLC 

8 

S 

0.004486 

1.000 

1.00000 

1.00000 

1.00000 

0.00000 

151 . 30 


9 

s 

0.007514 

12.700 

1.57182 

1.57597 

1.57182- 

-0.00415 

123 . 88 

POLYST 

10 

s 

0.000000 

130.000 

1.00000 

1.00000 

1.00000 

0.00000 

117.52 


11 

s 

0.00000031899.000 

1.00000 

1.00000 

1.00000 

0.000006501 . 32 


12 

s 

0.000000% 

-31904.000 1.00000 1.00000 1.00000 0.00000 116.66 


13 

s 

0 . 000000 

1.949 

1.00000 

1.00000 

1.00000 

0.00000 

116.66 



ASPHERIC SURFACE 2 CC 
A4 - 4 . 479591E-09 A6 
ASPHERIC SURFACE 4 CC 
A4 = 1 • 901898E-11 A6 
ASPHERIC SURFACE 6 CC 
A4 =-3 . 357945E-09 A6 


= 2.477985 

=-8 .7438 3 2E-1 4 A8 = 1.936009E-18 A10 =-3 . 557055E-23 

= -1.247590 

= 7 . 800049E-1 4 A8 =-l . 635492E-18 A10 = 2.510175E-23 

= -0.354793 (ELLIPSE) 

= 1 . 277421E-1 4 A8 =-2 . 20762E-18 A10 = 3.734123E-23 


Defocus 

L 


-0.750000 U '= 
M X 

-0.19969 
-0.09998 


- 0.200000 

Y OPD COLOR 

0.04986 -0.01416 -0.03584 
0.07627 -0.00368 -0.00851 


S 


T DIST ( % ) 


CHIEF RAY 


-0.19978 

-0.17600 

-0.13995 

- 0.10010 


-0.00103 

0.19907 

0.17949 

0.15946 

0.13912 

0.09930 

0.05917 

-0.06125 

-0.10137 

-0.14071 

-0.16149 

-0.18155 

-0.20055 

-0.00134 

-0.00127 

-0.00119 

- 0.00112 


-0.00402 

0.07360 

0.08343 

0.05048 


32.80324 

0.07775 

0.00651 

-0.03360 

-0.05378 

-0.05975 

-0.04020 

0.04603 

0.11702 

0.20302 

0.21961 

0.19138 

0.11954 

0.04571 

0.03750 

0.02058 

0.00561 


-0.00609 

-0.00685 

-0.00653 

-0.00562 

-0.00324 

-0.00118 

- 0.00120 

-0.00433 

-0.01070 

-0.01516 

-0.01936 

-0.02238 

-0.00899 

-0.00800 

-0.00492 

-0.00223 


-0.01198 

-0.00756 

-0.00384 

-0.00086 

0.00278 

0.00367 

-0.00976 

-0.01992 

-0.03304 

-0.04132 

-0.05025 

-0.05961 

-0.03587 

-0.02743 

-0.01699 

-0.00853 


0.417 0.592 -0.251% 




ZOOM POSITION 2 
EFL = 627.483 

# TYPE CURVE 

1 S 0.000000 

2 A 0.002135 


0.001060 0.000860 0.001060 
SEPN INDEX1 INDEX2 INDEX3 DISPN CLRAD GLASS 
0.000 1.00000 1.00000 1.00000 0.00000 125.61 
400.000 1.00000 1.00000 1.00000 0.00000 195.34 


PWWHNi. P9 ... V* Am* NU! r*; s-.ro 
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3 s 0.003544 12.700 1.57182 1.57597 1.57182-0.00415 190.58 POLYST 

4 A 0.004324 1.000 1.00000 1.00000 1.00000 0.00000 193.87 

5 s 0.000633 81.524 1.48222 1.48466 1.48222-0.00245 193.08 ACRYLC 

6 A 0.006593 543.944 1.00000 1.00000 1.00000 0.00000 170.50 

7 s 0.002784 102.098 1.48222 1.48466 1.48222-0.00245 164.06 ACRYLC 

8 S 0.004486 1.000 1.00000 1.00000 1.00000 0.00000 151.30 

9 s 0.007514 12.700 1.57182 1.57597 1.57182-0.00415 123.88 POLYST 

10 S 0.000000 130.000 1.00000 1.00000 1.00000 0.00000 117.52 

11 s 0.00000031899.000 1.00000 1.00000 1.00000 0.000006501.32 

12 S 0 . 000000%-31904 . 000 1.00000 1.00000 1.00000 0.00000 116.66 

13 s 0.000000 1.949 1.00000 1.00000 1.00000 0.00000 116.66 

ASPHERIC SURFACE 2 CC = 2.477985 

A 4 = 4 . 479591E-09 A 6 =-8 . 743832E-14 A 8 = 1.936009E-18 A10 =-3 . 557055E-23 

ASPHERIC SURFACE 4 CC = -1.247590 

A4 = 1 . 901898E-11 A 6 = 7.800049E-14 A 8 =-l . 635492E-18 A10 = 2.510175E-23 

ASPHERIC SURFACE 6 CC = -0.354793 (ELLIPSE) 

A4 =-3 . 357945E-09 A 6 = 1.277421E-14 A 8 =-2 . 20762E-18 A10 = 3.734123E-23 


Defocus = 

-0.750000 

0 

1 

II 

0* 

O 

. 200000 

L 

M 

X 

Y 


-0.19969 


0.04986 


-0.13991 


0.11692 

CHIEF RAY 

-0.00205 


65.25814 


0.19826 


0.12553 


0.18082 


0.04902 


0.16049 


-0.00682 


0 . 13813 


-0.03681 


0.09953 


-0.03873 


0.05891 


-0.01573 


-0.06303 


0.05263 


-0 . 10367 


0.14769 


-0.14219 


0.20683 


-0.16474 


0.19081 


-0.18511 


0.16483 


-0.20232 


0.18265 

-0.19982 

-0.00249 

-0.14106 

0.07209 

-0.17672 

-0.00239 

-0.04290 

0.06486 

-0.13995 

-0.00227 

-0.00309 

0.04179 

-0.10048 

-0.00217 

-0.01555 

0.01664 


OPD COLOR S T DIST( % ) 

-0.01416 -0.03584 
-0.00754 -0.01698 

-0.430 0.173 -1.052% 

-0.00176 0.01159 

-0.00323 0.01322 

-0.00361 0.01443 

-0.00307 0.01496 

-0.00146 0.01392 

-0.00035 0.01030 

-0.00106 -0.01655 
-0.00504 -0.03150 
-0.01216 -0.04893 
-0.01671 -0.06073 
-0.02030 -0.07251 
-0.02320 -0.08339 
0.00431 -0.03583 
0.00233 -0.02764 
0.00180 -0.01698 
0.00147 -0.00859 


ZOOM POSITION 3 
EFL = 627.483 





0. 

001060 0 

.000860 

0.001060 




# 

TYPE 

CURVE 

SEPN 

INDEX1 

INDEX2 

INDEX3 

DISPN 

CLRAD 

GLASS 

1 

S 

0.000000 

0.000 

1.00000 

1.00000 

1.00000 

0.00000 

125.61 


2 

A 

0.002135 

400.000 

1.00000 

1.00000 

1.00000 

0.00000 

195.34 


3 

S 

0.003544 

12.700 

1.57182 

1.57597 

1.57182- 

0.00415 

190.58 

POLYST 

4 

A 

0.004324 

1.000 

1.00000 

1.00000 

1.00000 

0.00000 

193.87 


5 

S 

0.000633 

81 . 524 

1.48222 

1.48466 

1.48222- 

0.00245 

193.08 

ACRYLC 

6 

A 

0.006593 

543.944 

1.00000 

1.00000 

1.00000 

0.00000 

170.50 


7 

S 

0.002784 

102.098 

1.48222 

1.48466 

1.48222- 

0.00245 

164.06 

ACRYLC 

8 

s 

0.004486 

1.000 

1.00000 

1.00000 

1.00000 

0.00000 

151.30 


9 

s 

0.007514 

12.700 

1.57182 

1.57597 

1.57182- 

0.00415 

123.88 

POLYST 

10 

s 

0.000000 

130.000 

1.00000 

1.00000 

1.00000 

0.00000 

117.52 


11 

s 

0.00000031899.000 

1.00000 

1.00000 

1.00000 

0.000006501.32 


12 

s 

0 . 000000 % 

-31904.000 1.00000 1.00000 1.00000 0.00000 116.' 

66 
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13 S 0.000000 

ASPHERIC SURFACE 2 CC 
A4 = 4 . 479591E-09 A6 
ASPHERIC SURFACE 4 CC 
A4 = 1 . 901898E-11 A6 = 
ASPHERIC SURFACE 6 CC = 
A4 ——3 .35794 5E-09 A6 = 

Defocus = -0.750000 U' 

L M X 

-0 . 19969 
-0 . 15984 


1.949 1.00000 1.00000 1.00000 0.00000 116.66 


2 . 477985 

•8 . 74 3832E-14 A8 = 1.936009E-18 
-1.247590 

7 . 800049E-14 A8 =-l . 635492E-18 
-0.354793 (ELLIPSE) 

1 . 277421E-14 A8 =-2 . 20762E-18 


A10 =-3 . 557055E-23 
A10 = 2 . 510175E-23 
A10 = 3 . 734123E-23 


- 0.200000 

Y OPD COLOR S 

0.04986 -0.01416 -0.03584 
0.12738 -0.01000 -0.02241 


T DIST( % ) 


CHIEF RAY -0.00304 
0.19779 
0.17875 
0.15781 
0.13743 
0.09723 
0 . 05966 


-0.06588 


-0.10371 


-0.14185 


-0.16487 


-0.18587 


-0.20156 


-0.20020 -0.00284 

-0.22885 

-0.17814 -0.00287 

-0.11858 

-0.14014 -0.00292 

-0.04832 

-0.10124 -0.00298 

-0.04757 


96.92833 
0 . 03167 
-0.02492 
-0 . 04897 
-0.04607 
-0 . 00947 
0.01291 
0.03325 
0.05731 
0.02371 
0.03433 
0.12763 
0 . 08258 
0.03963 
0.04820 
0.04450 
0.02520 


-0.00231 
-0.00231 
-0 . 00148 
-0 . 00048 
0 . 00068 
0.00053 
-0.00060 
-0.00246 
-0.00413 
-0.00464 
-0.00625 
-0.00832 
0.01175 
0 . 00803 
0.00523 
0.00344 


0.03478 

0.03394 

0.03241 

0.03030 

0.02446 

0.01699 

-0.02355 

-0.04142 

-0.06264 

-0.07727 

-0.09200 

-0.10363 

-0.03573 

-0.02793 

-0.01695 

-0.00869 


-0.915 -0.155 -2.472% 


ZOOM POSITION 4 


EFL = 627. 

483 

# TYPE 

CURVE 

1 S 

0 . 000000 

2 A 

0.002135 

3 S 

0.003544 

4 A 

0.004324 

5 S 

0 . 000633 

6 A 

0.006593 

7 S 

0 . 002784 

8 S 

0.004486 

9 S 

0 . 007514 

10 S 

0.000000 

11 S 

0.0000003 

12 S 

0.000000% 

13 S 

0 . 000000 


0.001060 0. 
SEPN INDEX1 
1 . 00000 
1.00000 


0.000 
400 . 000 


12.700 1.57182 
1.000 1.00000 
81.524 1.48222 
543.944 1.00000 
102.098 1.48222 
1.000 1.00000 
12.700 1.57182 
130.000 1.00000 


000860 
INDEX2 
. 00000 
. 00000 
.57597 
.00000 
. 48466 
.00000 
48466 
00000 
57597 
00000 
00000 


.001060 
INDEX3 
.00000 0 
.00000 0 
.57182-0 
.00000 0 
48222-0 
00000 0 
48222-0 
00000 0 
57182-0 
00000 0 
00000 0 
1.00000 


DISPN CLRAD 
.00000 125.61 
.00000 195.34 
.00415 190.58 
.00000 193.87 
.00245 193.08 
.00000 170.50 
.00245 164.06 
.00000 151.30 
.00415 123.88 
.00000 117.52 
.000006501 . 32 
0.00000 116.6 


L9U4.000 1.00000 1.00000 
1.949 1.00000 1.00000 1.00000 0.00000 118.25 


GLASS 

POLYST 

ACRYLC 

ACRYLC 

POLYST 


ASPHERIC SURFACE 2 CC 
A4 = 4 . 479591E-09 A6 
ASPHERIC SURFACE 4 CC 
A4 = 1 . 901898E-11 A6 
ASPHERIC SURFACE 6 CC 
A4 =— 3 . 357945E-09 A6 


= 2.477985 

=- 8 . 743832E-14 A8 = 1 

= -1.247590 

= 7 . 800049E-14 A8 =-l 

= -0.354793 (ELLIPSE) 

= 1 . 277421E-14 A8 =-2 


936009E— 18 A10 =-3 . 557055E-23 
635492E— 18 A10 = 2.510175E-23 
20762E-18 A10 = 3.734123E-23 
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Defocus = -0.750000 

U ' = -0 

.200000 



4~» 

L M 

X 

Y 

OPD 

COLOR 

S T DIST ( % ) 

-0.19969 


0.04986 

-0.01416 

-0.03584 


-0 .17977 


0.11205 

-0.01245 

-0.02869 


CHIEF RAY -0.00367 


117 . 07032 _ 



0.299 -0.077 -4.019% 

0.17954 


*0.0X506 

0.00699 

0.04752 


0.15564 


0.04058 

0.00601 

0.04344 


0.14243 


0.04538 

0.00545 

0.04092 


0.12483 


0.05329 

0.00458 

0.03725 


0.09603 


0.05833 

0.00294 

0.03056 


0.05610 


0.03814 

0.00092 

0.01980 


-0.06281 


0.03820 

-0.00079 

-0.02515 


-0.10180 


0.05982 

-0.00283 

-0.04553 


-0.13616 


0.07907 

-0.00501 

-0.06658 


-0.14681 


0.11211 

-0.00601 

-0.07383 


-0.15956 


0.16762 

-0.00780 

-0.08299 


-0.18130 


-0.03959 

-0.01074 

-0.09906 


-0.19916 -0.00069 

-0.00202 

-0.03419 

-0.01153 

-0.03449 


-0.18002 -0.00122 

0.07080 

-0.01468 

-0.01080 

-0.02788 


-0.13936 -0.00217 

0.11434 

0.01284 

-0.00658 

-0.01638 


-0.10226 -0.00285 

0.07775 

0.01406 

-0.00293 

-0.00868 
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LDT NASA TELESCOPE AT 860NM WAVELENGTH File ldtplas 
ZOOM POSITION 1 


10:49:05 


02-14-1991 


EFL = 


625.402 


# 

1 

2 

3 

4 

5 

6 

7 

8 
9 

10 

11 

12 


TYPE 

S 

A 

S 

A 

S 

A 

S 

S 

S 

S 

S 

S 


CURVE 

0 

SEPN 

. 000860 
INDEX1 

0.000820 

INDEX2 

0.000860 
INDEX3 DISPN 

CLRAD 

GLASS 

0 . 000000 

0.000 

1.00000 

1 . 00000 

1.00000 0.00000 

125.61 

0 . 002135 

400.000 

1.00000 

1.00000 

1.00000 0.00000 

195.34 


0.003544 

12.700 

1 . 57597 

1.57720 

1 . 57597-0 . 00123 

190 . 58 

POLYST 

0 . 004324 

1 . 000 

1.00000 

1.00000 

1.00000 0.00000 

193.87 

0 . 000633 

81.524 

1.48466 

1.48527 

1.48466-0.00061 

193.08 

ACRYLC 

0 . 006593 

543 . 944 

1.00000 

1.00000 

1.00000 0.00000 

170.50 

0.002784 

102 . 098 

1 . 48466 

1.48527 

1.48466-0.00061 

164.06 

ACRYLC 

0 . 004486 

1.000 

1 . 00000 

1.00000 

1.00000 0.00000 

151.30 

0.007514 

12.700 

1.57597 

1.57720 

1.57597-0.00123 

123.88 

POLYST 

0 . 000000 

130 . 000 

1 . 00000 

1 .00000 

1.00000 0.00000 

117 . 52 

0.00000031899.000 

1 . 00000 

1.00000 

1.00000 0.000006503.48 


0.000000%- 

31904.000 1.00000 1.00000 1.00000 0.00000 116.66 


0.000000 

0.291 

1.00000 

1 . 00000 

1.00000 0.00000 

116.66 



13 S 

ASPHERIC SURFACE 2 CC = 2.477985 

A4 — 4.479591E-09 A6 =-8 . 743832E-14 A8 = 1.936009E-18 A10 =-3 . 557055E-23 

ASPHERIC SURFACE 4 CC = -1.247590 

A4 = 1 • 901898E-11 A6 = 7.800049E-14 A8 =-l . 635492E-18 A10 = 2 510175E-23 

ASPHERIC SURFACE 6 CC = -0.354793 (ELLIPSE) ^.P10175E 23 

A4 =-3 . 357945E-09 A6 = 1.277421E-14 A8 =-2 . 20762E-18 A10 = 3.734123E-23 


Defocus = -0.750000 U' = -0.200000 


L M 

X 

Y 

-0.19974 


0.00782 

-0 . 09999 


0 . 07005 

CHIEF RAY -0.00102 


32.69479 

0.19913 


0 . 09423 

0.17953 


0.01709 

0.15949 


-0.02777 

0.13914 


-0.05146 

0.09931 


-0 . 06087 

0 . 05917 


-0.04151 

-0.06125 


0.04188 

-0 . 10137 


0 . 10328 

-0 . 14073 


0.17362 

-0.16151 


0.17955 

-0.18157 


0 .13922 

-0.20059 


0.05339 

-0.19983 -0.00134 

-0.04542 

0.03665 

-0.17603 -0.00127 

0.04374 

0 .03022 

-0.13997 -0.00118 

0.06736 

0.01578 

-0.10010 -0.00111 

0.04438 

0 . 00310 

ZOOM POSITION 2 
EFL = 625.402 

0 

.000860 0 

# TYPE CURVE 

SEPN 

INDEX1 


OPD 


COLOR 


-0.00566 -0.00205 
-0.00668 -0.00122 
-0.00653 -0.00053 
-0.00570 0.00000 
-0.00333 0.00062 
-0.00121 0.00073 
-0.00112 -0.00182 
-0.00391 -0.00373 
-0.00946 -0.00624 
-0.01320 -0.00785 
-0.01648 -0.00962 
-0.01838 -0.01149 
-0.00676 -0.00675 
-0.00661 -0.00511 
-0.00434 -0.00311 
-0.00208 -0.00154 


DIST( % ) 


0.418 0.593 -0.250% 


1 S 

2 A 

3 S 


INDEX2 

0.000000 0.000 1.00000 1.00000 

0.002135 400.000 1.00000 1.00000 

0.003544 12.700 1.57597 1.57720 


0.000860 

INDEX3 DISPN CLRAD GLASS 
1.00000 0.00000 125.61 
1.00000 0.00000 195.34 
1.57597-0.00123 190.58 POLYST 


-A9- 
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4 a 0.004324 1.000 1.00000 

5 s 0.000633 81.524 1.48466 

6 A 0.006593 543.944 1.00000 

7 s 0.002784 102.098 1.48466 

8 S 0.004486 1.000 1.00000 

9 s 0.007514 12.700 1.57597 

10 S 0.000000 130.000 1.00000 

11 s 0.00000031899.000 1.00000 

12 S 0.0000001-31904.000 1.000 


1.00000 1.00000 0.00000 193.87 
1.48527 1.48466-0.00061 193.08 ACRYLC 

1.00000 1.00000 0.00000 170.50 
1.48527 1.48466-0.00061 164.06 ACRYLC 

1.00000 1.00000 0.00000 151.30 
1.57720 1.57597-0.00123 123.88 POLYST 

1.00000 1.00000 0.00000 117.52 

1.00000 1.00000 0.000006503.48 
0 1.00000 1.00000 0.00000 116.66 


0.000000 0.291 1.00000 1.00000 1.00000 0.00000 116.66 


ASPHERIC SURFACE 2 CC 
A4 = 4 . 479591E-09 A6 
ASPHERIC SURFACE 4 CC 
A4 = 1 . 901898E-11 A6 
ASPHERIC SURFACE 6 CC 
A4 =-3 . 357945E-09 A6 


= 2.477985 

=-8 . 743832E-14 A8 = 1.936009E-18 A10 =-3 . 557055E-23 

= -1.247590 

= 7.800049E-14 A8 =-l . 635492E-18 A10 = 2.510175E-23 

= -0.354793 (ELLIPSE) 

= 1 . 277421E-14 A8 =-2 . 20762E-18 A10 = 3.734123E-23 


Defocus = -0.750000 

L M 

-0.19974 
-0.13993 

CHIEF RAY -0.00204 
0.19831 
0.18087 
0.16052 
0.13815 
0.09953 
0.05891 
-0.06302 
-0.10366 
-0.14219 
-0.16474 
-0.18512 
-0.20234 
-0.19987 -0.00248 
-0.17675 -0.00238 
-0.13996 -0.00226 
-0.10049 -0.00216 


U'= -0.200000 

X Y 

0.00782 
0.10059 

65.04438 
0.11282 
0.03529 
-0.02073 
-0.04984 
-0.04824 
-0.02027 
0.04526 
0.12615 
0.16511 
0.13306 
0.08751 
0.08373 
-0.18066 0.05366 

-0.07161 0.04995 

-0.01835 0.03193 

-0.02132 0.01136 


OPD COLOR 

-0.01189 -0.00674 
-0.00696 -0.00310 


-0.00340 0.00248 

-0.00465 0.00275 

-0.00474 0.00294 

-0.00390 0.00299 

-0.00185 0.00271 

-0.00045 0.00197 

-0.00091 -0.00312 
-0.00434 -0.00597 
-0.01026 -0.00938 
-0.01369 -0.01172 
-0.01593 -0.01410 
-0.01732 -0.01633 
0.00643 -0.00678 
0.00366 -0.00517 
0.00233 -0.00313 
0.00161 -0.00156 


T DIST ( % ) 


424 0.173 -1.048% 


ZOOM POSITION 3 

EFL = 625.402 * 





0. 

000860 0 

.000820 

0.000860 




# 

TYPE 

CURVE 

SEPN 

INDEX1 

INDEX2 

INDEX3 

DISPN 

CLRAD 

GLASS 

1 

S 

0 . 000000 

0.000 

1.00000 

1.00000 

1.00000 

0.00000 

125.61 


2 

A 

0.002135 

400.000 

1.00000 

1.00000 

1.00000 

0.00000 

195.34 


3 

S 

0.003544 

12.700 

1.57597 

1.57720 

1.57597- 

0.00123 

190.58 

POLYST 

4 

A 

0.004324 

1.000 

1.00000 

1.00000 

1.00000 

0.00000 

193.87 


5 

S 

0.000633 

81.524 

1.48466 

1.48527 

1.48466- 

0.00061 

193.08 

ACRYLC 

6 

A 

0.006593 

543.944 

1.00000 

1.00000 

1.00000 

0.00000 

170.50 


7 

S 

0.002784 

102.098 

1.48466 

1.48527 

1.48466- 

0.00061 

164.06 

ACRYLC 

8 

S 

0.004486 

1.000 

1.00000 

1.00000 

1.00000 

0.00000 

151.30 


9 

s 

0.007514 

12.700 

1.57597 

1.57720 

1.57597- 

0.00123 

123.88 

POLYST 

10 

s 

0.000000 

130.000 

1.00000 

1.00000 

1.00000 

0.00000 

117.52 


11 

s 

0.00000031899.000 

1.00000 

1.00000 

1.00000 

0.000006503.48 


12 

s 

0.000000% 

-31904.000 1.00000 1.00000 1.00000 0.00000 116.66 
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13 S 


0.000000 


0.291 1.00000 1.00000 1.00000 0.00000 116.66 


ASPHERIC SURFACE 2 CC = 2.477985 

A4 = 4 . 479591E-09 A6 =-8 . 743832E-14 A8 = 1.936009E-18 A10 =-3 . 557055E-23 

ASPHERIC SURFACE 4 CC = -1.247590 

A4 = 1 . 901898E-11 A6 = 7.800049E-14 A8 =-l . 635492E-18 A10 = 2.510175E-23 

ASPHERIC SURFACE 6 CC = -0.354793 (ELLIPSE) 

A4 =-3 . 357945E-09 A6 = 1.277421E-14 A8 =-2 . 20762E-18 A10 = 3.734123E-23 


Defocus = -0.750000 

L 


U'= -0.200000 


M 

X 

Y 

OPD 

COLOR 

-0 . 19974 


0.00782 

-0.01189 

-0.00674 

-0.15987 


0.10385 

-0.00902 

-0.00413 

-0 . 00303 


96.61543 



0.19787 


-0.01894 

-0.00682 

0.00675 

0.17881 


-0.07098 

-0.00590 

0.00655 

0.15785 


-0.08929 

-0.00416 

0.00621 

0.13745 


-0.08022 

-0.00240 

0.00577 

0.09723 


-0.03064 

-0.00012 

0.00462 

0.05966 


0.00304 

0.00030 

0.00319 

-0.06584 


0.02439 

-0.00043 

-0.00445 

-0.10366 


0.03367 

-0.00169 

-0.00791 

-0.14178 


-0.02558 

-0.00202 

-0.01211 

-0.16481 


-0.04109 

-0.00112 

-0.01507 

-0.18581 


0.02694 

-0.00085 

-0.01807 

-0.20146 


-0.00352 

-0.00138 

-0.02048 

-0.00283 

-0.26677 

0.01110 

0.01379 

-0.00683 

-0.00286 

-0.14624 

0.02503 

0.00935 

-0.00528 

-0.00291 

-0.06298 

0.02921 

0.00576 

-0.00315 

-0.00297 

-0.05346 

0.01674 

0.00359 

-0.00160 


DIST ( % ) 


-0.912 -0.135 -2.463% 


ZOOM POSITION 4 
EFL = 625.402 


# 

TYPE 

CURVE 

0 

SEPN 

.000860 

INDEX1 

0.000820 

INDEX2 

0.000860 
INDEX3 DISPN 

CLRAD 

GLASS 

1 

S 

0 . 000000 

0.000 

1 . 00000 

1.00000 

1.00000 0.00000 

125.61 


2 

A 

0.002135 

400 . 000 

1.00000 

1.00000 

1.00000 0.00000 

195.34 


3 

S 

0.003544 

12.700 

1.57597 

1.57720 

1.57597-0.00123 

190.58 

POLYST 

4 

A 

0.004324 

1.000 

1.00000 

1 . 00000 

1.00000 0.00000 

193.87 

5 

S 

0.000633 

81 . 524 

1.48466 

1.48527 

1.48466-0.00061 

193.08 

ACRYLC 

6 

A 

0.006593 

543 . 944 

1 . 00000 

1.00000 

1.00000 0.00000 

170.50 

7 

S 

0.002784 

102.098 

1 . 48466 

1.48527 

1.48466-0.00061 

164.06 4 

ACRYLC 

8 

S 

0.004486 

1.000 

1.00000 

1.00000 

1.00000 0.00000 

151.30 


9 

S 

0.007514 

12.700 

1.57597 

1.57720 

1.57597-0.00123 

123.88 

POLYST 

10 

s 

0 . 000000 

130.000 

1.00000 

1.00000 

1.00000 0.00000 

117.52 

11 

s 

0.00000031899.000 

1.00000 

1.00000 

1.00000 0.000006503.48 


12 

s 

0.000000%- 

31904.000 1.00000 1.00000 1.00000 0.00000 116.66 


13 

s 

0.000000 

0.291 

1.00000 

1.00000 

1.00000 0.00000 

117.83 



ASPHERIC SURFACE 2 CC = 2.477985 

A4 = 4 . 479591E-09 A6 =-8 . 743832E-14 A8 = 1.936009E-18 A10 =-3 . 557055E-23 

ASPHERIC SURFACE 4 CC = -1.247590 

A4 = 1 . 901898E-11 A6 = 7.800049E-14 A8 =-l . 635492E-18 A10 = 2.510175E-23 

ASPHERIC SURFACE 6 CC = -0.354793 (ELLIPSE) 

A4 =- 3 • 357945E-09 A6 = 1.277421E-14 A8 =-2 . 20762E-18 A10 = 3.734123E-23 

Defocus = -0.750000 U' = -0.200000 


-All- 
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T M X Y OPD COLOR S T DIST(% 



-0.19974 


0.00782 


-0.17981 


0.07994 

CHIEF RAY 

-0.00366 




0.17959 


-0.04771 


0.15563 


-0.03813 


0.14241 


-0.02503 


0.12479 


-0.00574 


0 . 09598 


0.01784 


0.05606 


0.02024 


-0 . 06275 


0.03073 


-0.10174 


0.03255 


-0.13614 


0.01518 


-0.14682 


0.03183 


-0.15960 


0.07045 


-0.18124 


-0.07965 

-0.19919 

-0.00072 

-0.04115 

-0.07250 

-0.18003 

-0.00124 

0.04133 

-0.04612 

-0.13935 

-0.00218 

0.09865 

-0.00714 

-0.10225 

-0.00285 

0.07019 

0.00257 


-0.01189 -0.00674 
-0.01092 -0.00534 

0.281 0.013 -3 . 999 : 

-0.00019 0.00886 

0.00089 0.00807 

0.00131 0.00759 

0.00159 0.00690 

0.00137 0.00565 

0.00050 0.00366 

-0.00069 -0.00473 
-0.00210 -0.00867 
-0.00280 -0.01286 
-0.00303 -0.01432 
-0.00368 -0.01618 
-0.00476 -0.01952 
-0.00938 -0.00664 
-0.00928 -0.00532 
-0.00593 -0.00307 
-0.00269 -0.00161 
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LDT NASA TELESCOPE AT 820NM WAVELENGTH File ldtDlas 
ZOOM POSITION 1 P 

EFL = 625.007 


10:38:13 


02-14-1991 


# TYPE 

1 S 

2 A 

3 S 

4 A 

5 S 

6 A 

7 S 

8 S 

9 S 

10 S 

11 S 

12 S 

13 S 


0.000820 0. 

CURVE SEPN INDEX1 

0.000000 0.000 1.00000 1 

0.002135 400.000 1.00000 1 

0.003544 12.700 1.57720 1 

0.004324 1.000 1.00000 1 

0.000633 81.524 1.48527 1 

0.006593 543.944 1.00000 1 

0.002784 102.098 1.48527 1 

0.004486 1.000 1.00000 1 

0.007514 12.700 1.57720 1 

0.000000 130.000 1.00000 1 

0.00000031899.000 1.00000 1 
0 . 000000%-31904 . 000 1.00000 


0.004324 

0.000633 


0 . 004486 
0.007514 


000860 0.000820 

INDEX2 INDEX3 DISPN CLRAD GLASS 
.00000 1.00000 0.00000 125.61 
.00000 1.00000 0.00000 195.34 
.57597 1.57720 0.00123 190.58 POLYST 
.00000 1.00000 0.00000 193.87 
.48466 1.48527 0.00061 193.08 ACRYLC 
.00000 1.00000 0.00000 170.50 
.48466 1.48527 0.00061 164.06 ACRYLC 
.00000 1.00000 0.00000 151.30 
.57597 1.57720 0.00123 123.88 POLYST 
.00000 1.00000 0.00000 117.52 
.00000 1.00000 0.000006504.12 
1.00000 1.00000 0.00000 116.66 


0.000000 -0.004 1.00000 1.00000 1.00000 0.00000 116.66 


ASPHERIC SURFACE 2 CC = 2.477985 

A4 = 4 . 479591E-09 A6 =-8 . 743832E-14 A8 = 1.936009E-18 A10 3 R1 : 7 n«r 

ASPHERIC SURFACE 4 CC = -1.247590 18 A1 ° — 3 • 557055E-23 

A4 = 1 . 901898E-11 A6 = 7.800049E-14 A8 =-l . 635492E-18 A10 = 2 51017RF 33 

ASPHERIC SURFACE 6 CC = -0.354793 (ELLIPSE) 2.510175E-23 

A4 =- 3 . 357945E-09 A6 = 1.277421E-14 A8 =-2 . 20762E-18 A10 = 3.734123E-23 

Defocus = -0.750000 U'= -0.200000 

^ ^ ^ ^ OPD COLOR S T nT<?Tf * ^ 

-0.19976 -0.00731 -0.01109 0.00673 

-0.09999 0.06787 -0.00347 0.00153 


CHIEF RAY -0.00102 
0 .19914 
0.17954 
0.15950 
0.13914 
0.09931 
0.05917 
-0.06125 
-0.10137 
-0.14073 
-0.16152 
-0.18159 
-0.20061 
-0.19984 -0.00134 
-0.17605 -0.00127 
-0.13998 -0.00118 
- 0.10010 - 0.00111 


-0.06054 
0 . 03297 
0.06162 
0.04215 


32.67420 
0 . 10167 
0.02215 
-0.02463 
-0.04977 
-0 . 06075 
-0.04173 
0 . 04038 
0 . 09857 
0.16351 
0.16562 
0.12086 
0.03005 
0.03380 
0.02795 
0.01430 
0.00232 


-0.00539 0.00204 

-0.00653 0.00121 


0.418 0.590 -0.250% 


-0.00646 

-0.00568 


0.00053 

- 0.00000 


-0.00334 -0.00062 
-0.00122 -0.00073 
-0.00109 0.00182 
-0.00377 0.00373 
-0.00903 0.00623 
-0.01252 0.00784 
-0.01548 0.00960 
-0.01699 0.01147 
-0.00595 0.00674 
-0.00611 0.00510 
-0.00413 0.00311 
-0.00202 0.00154 


ZOOM POSITION 2 
EFL = 625.007 

# TYPE CURVE 

1 S 0.000000 

2 A 0.002135 

3 S 0.003544 


0.000820 0.000860 
SEPN INDEX1 INDEX2 
0.000 1.00000 1.00000 

400.000 1.00000 1.00000 
12.700 1.57720 1.57597 

-A13- 


0.000820 

INDEX3 DISPN CLRAD 

1.00000 0.00000 125.61 

1.00000 0.00000 195.34 
1.57720 0.00123 190.58 


GLASS 

POLYST 
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4 

5 

6 

7 

8 
9 

10 

11 

12 


A 

S 

A 

S 

s 

s 

s 

s 

s 


0 . 004324 
0.000633 
0.006593 
0.002784 
0.004486 
0 . 007514 
0.000000 


1.000 
81.524 
543.944 
102 . 098 
1 . 000 
12 . 700 
130.000 


00000 

48527 

00000 

48527 

00000 

57720 

00000 

00000 


,00000 
, 48466 
.00000 
,48466 
. 00000 
.57597 
.00000 
.00000 


00000 0. 
48527 0. 
.00000 0 
,48527 0 
.00000 0 
,57720 0 
.00000 0 
.00000 0 
1.00000 


00000 193.87 
00061 193.08 
00000 170.50 
00061 164.06 
00000 151.30 
00123 123.88 
00000 117.52 
000006504 .12 
0.00000 116.66 


ACRYLC 

ACRYLC 

POLYST 


13 S 


0.00000031899.000 

0.000000%-31904.000 1.00000 1.00000 
0.000000 -0.004 1.00000 1.00000 1.00000 0.00000 116.66 


ASPHERIC SURFACE 2 CC 
A4 = 4 . 479591E-09 A6 
ASPHERIC SURFACE 4 CC 
A4 = 1 . 901898E-1 1 A6 
ASPHERIC SURFACE 6 CC 
A4 =— 3 . 357945E-09 A6 


= 2.477985 _ 

=_g _ 743832E— 14 A8 = 1.936009E— 18 A10 — — 3.557055E 23 

= -1.247590 

= 7.800049E-14 A8 =— 1 . 635492E-18 A10 — 2.510175E 23 

= -0.354793 (ELLIPSE) 

= 1.277421E-14 A8 =-2 . 20762E-18 A10 = 3.734123E-23 


DIST( % ) 


Defocus = —0.750000 U'— 0 

L M X 

. 200000 
Y 

OPD 

COLOR 

-0.19976 

-0.00731 

-0.01109 

0 . 00673 

-0.13994 

0.09487 

-0.00675 

0.00310 

CHIEF RAY -0.00204 
0.19832 

65 . 00388 
0 . 11268 

-0.00361 

-0.00248 

0.18087 

0.03426 

-0.00485 

-0.00275 

0.16052 

-0.02241 

-0.00491 

-0.00294 

0.13815 

-0.05179 

-0.00403 

-0.00298 

0.09953 

-0.04984 

-0.00191 

-0.00271 

0.05891 

-0.02093 

-0.00046 

-0.00197 

-0.06301 

0.04239 

-0.00085 

0.00311 

-0.10366 

0.11834 

-0.00407 

0.00597 

-0.14219 

0.15001 

-0.00955 

0.00936 

-0.16475 

0.11225 

-0.01259 

0.01171 

-0.18513 

0.06032 

-0.01433 

0.01408 

-0.20236 

0.05013 

-0.01520 

0.01630 

-0.19989 -0.00248 -0.19576 

0.04791 

0.00725 

0.00677 

-0.17676 -0.00238 -0.08250 

0.04536 

0.00419 

0.00516 

-0.13997 -0.00226 -0.02417 

0.02895 

0.00255 

0 . 00312 

-0.10049 -0.00216 -0.02368 

0.00978 

0.00167 

0 . 00156 

ZOOM POSITION 3 
EFL = 625.007 

0 . 000820 

0.000860 

0.000820 


-0.426 0.162 -1.047% 


# 

TYPE 

CURVE 

1 

S 

0.000000 

2 

A 

0.002135 

3 

S 

0.003544 

4 

A 

0.004324 

5 

S 

0.000633 

6 

A 

0.006593 

7 

S 

0.002784 

8 

S 

0.004486 

9 

S 

0.007514 

10 

S 

0.000000 

11 

S 

0.0000003 

12 

S 

0.000000% 


SEPN INDEX1 INDEX2 INDEX3 


GLASS 


0.000 1.00000 
400.000 1.00000 
12.700 1.57720 
1.000 1.00000 
81.524 1.48527 


543 . 944 
102.098 


1.00000 

1.48527 


1.000 1.00000 
12.700 1.57720 
130.000 1.00000 


.00000 

.00000 

.57597 

.00000 

.48466 

.00000 

.48466 

.00000 

.57597 

.00000 

.00000 


.00000 

.00000 

.57720 

.00000 

.48527 


.00000 0 
.48527 0 
.00000 0 
.57720 0 
.00000 0 
.00000 0 


1.00000 1.00000 


DISPN CLRAD 
.00000 125.61 
.00000 195.34 
.00123 190.58 
.00000 193.87 
.00061 193.08 
.00000 170.50 
.00061 164.06 
.00000 151.30 
.00123 123.88 POLYST 
.00000 117.52 
.000006504.12 
0.00000 116.66 


POLYST 

ACRYLC 


ACRYLC 
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13 S 


0.000000 -0.004 1.00000 1.00000 1.00000 0.00000 116.66 


ASPHERIC SURFACE 2 CC = 2.477985 

A4 = 4 . 479591E-09 A 6 =-8 . 743832E-14 A 8 = 1.936009E-18 A10 =-3 . 557055E-23 

ASPHERIC SURFACE 4 CC = -1.247590 

A4 = 1 . 901898E-11 A 6 = 7.800049E-14 A 8 =-l . 635492E-18 A10 = 2.510175E-23 

ASPHERIC SURFACE 6 CC = -0.354793 (ELLIPSE) 

A4 =-3 . 357945E-09 A 6 = 1.277421E-14 A 8 =-2 . 20762E-18 A10 = 3.734123E-23 


Defocus = -0.750000 U'= -0.200000 


L M 

X 

Y 

OPD 

COLOR 

-0.19976 


-0.00731 

-0.01109 

0.00673 

-0.15988 


0.09557 

-0.00868 

0.00413 

CHIEF RAY -0.00303 


96.55641 



0 .19788 


-0.02726 

-0.00753 

-0.00674 

0.17881 


-0.07872 

-0.00645 

-0.00654 

0.15785 


-0.09612 

-0.00456 

-0.00620 

0.13745 


-0.08594 

-0.00267 

-0.00577 

0.09723 


-0 . 03386 

-0.00021 

-0.00461 

0.05965 


0.00195 

0 . 00029 

-0.00319 

-0.06583 


0.01997 

-0.00033 

0.00444 

-0.10365 


0.02323 

-0.00131 

0.00789 

-0.14177 


-0.04536 

-0.00108 

0.01209 

-0.16480 


-0.06879 

0.00037 

0.01504 

-0.18581 


-0.00842 

0.00130 

0.01804 

-0.20146 


-0.03975 

0.00134 

0.02044 

-0.20026 -0.00283 

-0.28219 

0.00230 

0.01467 

0.00681 

-0.17818 -0.00286 

-0.15761 

0.01795 

0.00993 

0.00527 

-0.14015 -0.00291 

-0.06913 

0.02466 

0.00602 

0.00315 

-0.10124 -0.00297 

-0.05619 

0.01428 

0.00368 

0.00159 


DIST( % ) 


-0.918 -0.156 -2.461% 


ZOOM POSITION 4 
EFL = 625.007 





0 

. 000820 

0.000860 

0.000820 


# 

TYPE 

CURVE 

SEPN 

INDEX1 

INDEX2 

INDEX3 

DISPN 

CLRAD 

1 

S 

0.000000 

0.000 

1.00000 

1.00000 

1.00000 

0.00000 

125.61 

2 

A 

0.002135 

400.000 

1.00000 

1.00000 

1.00000 

0.00000 

195.34 

3 

S 

0 . 003544 

12 . 700 

1.57720 

1.57597 

1 . 57720 

0.00123 

190 . 58 

4 

A 

0 . 004324 

1.000 

1.00000 

1.00000 

1 . 00000 

0 . 00000 

193.87 

5 

S 

0.000633 

81.524 

1.48527 

1.48466 

1.48527 

0.00061 

193.08 

6 

A 

0.006593 

543 . 944 

1.00000 

1.00000 

1.00000 

0.00000 

170.50 

7 

S 

0.002784 

102.098 

1.48527 

1.48466 

1 . 48527 

0.00061 

164.06 4 

8 

S 

0.004486 

1.000 

1 . 00000 

1.00000 

1.00000 

0.00000 

151 . 30 

9 

S 

0.007514 

12.700 

1 . 57720 

1.57597 

1 . 57720 

0.00123 

123 . 88 

10 

S 

0.000000 

130.000 

1 . 00000 

1 . 00000 

1.00000 

0.00000 

117 . 52 

11 

S 

0.00000031899.000 

1 . 00000 

1.00000 

1.00000 

0.000006504 .12 

12 

S 

0 .000000% 

-31904.000 1.00000 1.00000 1.00000 0.00000 116.66 

13 

s 

0.000000 

-0.004 

1 . 00000 

1.00000 

1.00000 

0.00000 

117.83 


GLASS 


POLYST 

ACRYLC 


POLYST 


ASPHERIC SURFACE 2 CC = 2.477985 

A4 = 4 . 479591E-09 A6 =-8 . 74 3832E-14 A8 = 1.936009E-18 A10 =-3 . 557055E-23 

ASPHERIC SURFACE 4 CC = -1.247590 

A4 = 1.901898E-11 A6 = 7.800049E-14 A8 =— 1 . 635492E— 18 A10 = 2.510175E— 23 

ASPHERIC SURFACE 6 CC = -0.354793 (ELLIPSE) 

=-3 . 357945E-09 A6 = 1.277421E-14 A8 =-2 . 20762E-18 A10 = 3.734123E-23 

Defocus = -0.750000 U' = -0.200000 
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L M 

X 

Y 

-0.19976 


-0.00731 

-0.17982 


0 . 06854 

CHIEF RAY -0.00366 


116.63673 

0.17958 


-0 . 06361 

0.15562 


-0.05132 

0.14239 


-0.03663 

0.12477 


-0.01517 

0.09596 


0.01189 

0 . 05604 


0.01824 

-0 . 06274 


0.02587 

-0.10173 


0.01991 

-0.13613 


-0 . 00883 

-0.14682 


0.00328 

-0.15960 


0.03666 

-0.18124 


-0.11087 

-0.19920 -0.00073 

-0.05721 

-0.08369 

-0.18004 -0.00125 

0.02893 

-0.05533 

-0.13936 -0.00218 

0.09193 

-0.01287 

-0.10225 -0.00285 

0.06682 

-0.00063 


OPD COLOR S T DlST(% 

-0.01109 0.00673 

-0.01038 0.00533 

0.268 -0.006 -3 . 995' 

-0.00129 -0.00884 
0.00014 -0.00805 
0.00072 -0.00757 
0.00118 -0.00688 
0.00119 -0.00563 
0.00047 -0.00365 
-0.00059 0.00472 

-0.00167 0.00865 

-0.00175 0.01283 

-0.00170 0.01428 

-0.00195 0.01614 

-0.00228 0.01947 

-0.00844 0.00662 

-0.00861 0.00531 

-0.00564 0.00306 

-0.00257 0.00160 
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LOT NASA TELESCOPE AT 820NM WAVELENGTH File ldtplas 10:07:21 
ZOOM POSITION 1 
EFL = 625.007 


02-14-1991 





0 

.000820 

0. 000860 

0 . 000820 


# 

TYPE 

CURVE 

SEPN 

INDEX1 

INDEX2 

INDEX3 

DISPN 

CLRAD 

1 

S 

0.000000 

0 . 000 

1 . 00000 

1 . 00000 

1.00000 

0 . 00000 

125.61 

2 

A 

0.002135 

400.000 

1.00000 

1.00000 

1 . 00000 

0.00000 

195.34 

3 

S 

0.003544 

12.700 

1 . 57720 

1.57597 

1.57720 

0.00123 

190.58 

4 

A 

0.004324 

1 . 000 

1 . 00000 

1 . 00000 

1.00000 

0 . 00000 

193.87 

5 

S 

0 . 000633 

81.524 

1.48527 

1 . 48466 

1 . 48527 

0.00061 

193 . 08 

6 

A 

0.006593 

543 . 944 

1 . 00000 

1.00000 

1.00000 

0.00000 

170.50 

7 

S 

0.002784 

102 . 098 

1.48527 

1.48466 

1.48527 

0.00061 

164.06 

8 

S 

0.004486 

1.000 

1.00000 

1.00000 

1.00000 

0.00000 

151 . 30 

9 

S 

0.007514 

12.700 

1.57720 

1.57597 

1.57720 

0.00123 

123.88 

10 

S 

0.000000 

130.000 

1.00000 

1.00000 

1.00000 

0.00000 

117.52 

11 

S 

0.00000031899.000 

1.00000 

1.00000 

1.00000 

0.000006573.72 

12 

S 

0.000000%- 

31904.000 1.00000 1.00000 1.00000 0.00000 116.66 

13 

S 

0.000000 

-0.003 

1.00000 

1.00000 

1.00000 

0.00000 

116.66 


GLASS 

POLYST 

ACRYLC 

ACRYLC 

POLYST 


ASPHERIC SURFACE 2 CC 
A4 = 4 . 479591E-09 A6 
ASPHERIC SURFACE 4 CC 
A4 = 1 . 901898E-11 A6 
ASPHERIC SURFACE 6 CC 
A4 =-3 . 357945E-09 A6 


= 2.477985 

=-8.743832E-14 A8 = 1.936009E-18 A10 =-3 . 557055E-23 

= -1.247590 

= 7.800049E-14 A8 =-l . 635492E-18 A10 = 2.510175E-23 

= -0.354793 (ELLIPSE) 

= 1 . 277421E-14 A8 =-2 . 20762E-18 A10 = 3.734123E-23 


LDT NASA TELESCOPE AT 820NM WAVELENGTH File ldtplas 10:08*10 
ZOOM POSITION 1 F 

EFL = 625.007 


02-14-1991 


RADIUS 

PLANE 

SEPN 

468.277 

400 . 000 

282.162 

12.700 

231.275 

1.000 

1579.829 

81.524 

151.670 

543.944 

359.155 

102.098 

222.913 

1.000 

133.093 

12.700 

PLANE 

130.000 

PLANE 

31899 . 000 

PLANE 

%-31904 . 000 

PLANE 

-0.003 


ASPHERIC SURFACE 2 CC = 


CLR DIAM 
251 . 23 

MATERIA 

390.68 

Air 

381.15 

POLYST 

387.75 

Air 

386.16 

ACRYLC 

341.01 

Air 

328.13 

ACRYLC 

302.60 

Air 

247.76 

POLYST 

235.03 

Air 

13147.45 

Air 

233 . 32 

Air 

233 . 32 

Air 


2.477985 
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A4 = 4 . 479591E-09 A6 
ASPHERIC SURFACE 4 CC 
A4 = 1 . 901898E-11 A6 
ASPHERIC SURFACE 6 CC 
A4 =-3 . 357945E-09 A6 


=-8 . 743832E-14 A8 = 1.936009E-18 
= -1.247590 

= 7 . 800049E-14 A8 =-l . 635492E-18 
= -0.354793 (ELLIPSE) 

= 1 . 277421E-14 A8 =-2 . 20762E-18 


A10 =-3 . 557055E-23 
A10 = 2 . 510175E-23 
A10 = 3 . 734123E-23 


LOT NASA TELESCOPE AT 820NM WAVELENGTH File ldtplas 10:08:43 
ZOOM POSITION 1 
EFL = 625.007 


# Type 

1 P 

2 MD 

3 M 

4 CD 

5 MD 

6 M 

7 M 

8 M 

9 M 

10 M 

11 M 

12 M 

13 M 

14 M 

15 M 

16 MD 

17 S 

18 S 

19 S 

20 S 


Xrel 

Yrel 

X 

Y 

L 

M 

0 . 000 

1.000 

0.00000 

125.00238 

0.000000 

0 . 000000 

0 . 000 

1.000 

0 . 00000 

125.00238 

0.000000 

0.000000 

0.000 

0.500 

0.00000 

62.50119 

0.000000 

0.000000 

0 . 000 

3.000 

0.00000 

1.26883 

0.000000 

0.052336 

0 . 000 

-0.998 

0.00000 

-123.46299 

0.000000 

0.052336 

0 . 000 

-0.900 

0.00000 

-111.23332 

0.000000 

0.052336 

0 . 000 

-0.800 

0.00000 

-98.73308 

0.000000 

0.052336 

0 .000 

-0.698 

0.00000 

-86.04344 

0.000000 

0.052336 

0 . 000 

-0.500 

0.00000 

-61.23237 

0.000000 

0.052336 

0 . 000 

-0.300 

0.00000 

-36.23189 

0.000000 

0.052336 

0 . 000 

0 . 300 

0.00000 

38.76954 

0.000000 

0.052336 

0 . 000 

0.500 

0.00000 

63.77002 

0.000000 

0.052336 

0 . 000 

0.696 

0.00000 

88.31071 

0.000000 

0.052336 

0 . 000 

0.800 

0.00000 

101.27073 

0.000000 

0.052336 

0 . 000 

0.900 

0 . 00000 

113.77097 

0 . 000000 

0.052336 

0 . 000 

0.995 

0 . 00000 

125.61438 

0.000000 

0.052336 

0 . 999 

0.000 

124.89674 

1.26883 

0.000000 

0.052336 

0 . 880 

0 . 000 

110.00210 

1.26883 

0.000000 

0.052336 

0 . 699 

0.000 

87.42772 

1.26883 

0.000000 

0.052336 

0.500 

0.000 

62.50119 

1.26883 

0.000000 

0.052336 


ZOOM POSITION 2 
EFL = 625.007 


1 

Type 

Xrel 

Yrel 

21 

PZ 

0.000 

1.000 

22 

MD 

0.000 

1.000 

23 

M 

0.000 

0.700 

24 

CD 

0.000 

6.000 

25 

MD 

0.000 

-0.986 

26 

M 

0.000 

-0.900 

27 

M 

0.000 

-0.800 

28 

M 

0.000 

-0.690 

29 

M 

0.000 

-0.500 

30 

M 

0.000 

-0.300 

31 

M 

0.000 

0.300 

32 

M 

0.000 

0.500 

33 

M 

0.000 

0.689 

34 

M 

0.000 

0.800 

35 

M 

0 . 000 

0.900 

36 

MD 

0.000 

0.985 

37 

S 

0.995 

0.000 

38 

S 

0 . 880 

0.000 

39 

S 

0.697 

0.000 

40 

S 

0.500 

0.000 


X 

0.00000 

0.00000 

0.00000 

0.00000 
0.00000 
0.00000 
0 . 00000 
0 . 00000 
0.00000 
0.00000 
0 . 00000 
0 . 00000 
0.00000 
0.00000 
0.00000 
0.00000 
124.40148 
110.00210 
87.08103 
62.50119 


Y 

125.00238 

125.00238 

87.50167 

2.42560 

-120.79125 

-110.07654 

-97.57631 

-83.82619 

-60.07559 

-35.07512 

39.92631 

64.92679 

88.59774 

102.42751 

114.92774 

125.52866 

2.42560 

2.42560 

2.42560 

2.42560 


L 

0.000000 

0.000000 

0.000000 

0.000000 
0.000000 
0.000000 
0 . 000000 
0.000000 
0.000000 
0.000000 
0.000000 
0.000000 
0.000000 
0.000000 
0.000000 
0.000000 
0.000000 
0.000000 
0.000000 
0.000000 


M 

0.000000 

0.000000 

0.000000 

0.104529 

0.10452^ 

0.104529 

0.104529 

0.104529 

0.104529 

0.104529 

0.104529 

0.104529 

0.104529 

0.104529 

0.104529 

0.104529 

0.104529 

0.104529 

0.104529 

0.104529 
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ZOOM POSITION 3 


EFL = 625 

,007 


# Type 

Xrel 

Yrel 

41 PZ 

0.000 

1.000 

42 MD 

0.000 

1 . 000 

43 M 

0.000 

0.800 

44 CD 

0.000 

9.000 

45 MD 

0 . 000 

-0.961 

46 M 

0.000 

-0.870 

47 M 

0.000 

-0.770 

48 M 

0.000 

-0.673 

49 M 

0.000 

-0.480 

50 M 

0.000 

-0.300 

51 M 

0.000 

0.300 

52 M 

0 . 000 

0.480 

53 M 

0.000 

0.661 

54 M 

0.000 

0.770 

55 M 

0.000 

0.870 

56 MD 

0.000 

0.944 

57 S 

0.989 

0 . 000 

58 S 

0.880 

0.000 

59 S 

0.692 

0.000 

60 S 

0.500 

0 . 000 

ZOOM POSITION 4 


EFL = 625, 

007 


# Type 

Xrel 

Yrel 

61 PZ 

0.000 

1.000 

62 MD 

0.000 

1.000 

63 M 

0.000 

0.900 

64 CD 

0.000 

11.000 

65 MD 

0.000 

-0.829 

66 M 

0.000 

-0.720 

67 M 

0.000 

-0.660 

68 M 

0.000 

-0 . 580 

69 M 

0 . 000 

-0.450 

70 M 

0.000 

-0.270 

71 M 

0.000 

0.270 

72 M 

0.000 

0.450 

73 tf 

0.000 

0.610 

74 M 

0.000 

0.660 

75 M 

0.000 

0.720 

76 MD 

0.000 

0.820 

77 S 

0.973 

0 . 000 

78 S 

0 . 880 

0.000 

79 S 

0.681 

0.000 

80 S 

0.500 

0.000 


X 

0 . 00000 
0.00000 
0 . 00000 

0.00000 
0.00000 
0.00000 
0.00000 
0.00000 
0 . 00000 
0.00000 
0.00000 
0 . 00000 
0.00000 
0.00000 
0.00000 
0 . 00000 
123.61288 
110.00210 
86.52901 
62.50119 


Y 

125.00238 

125.00238 

100.00191 

5.60687 

-114.48861 

-103.14520 

-90.64496 

-78.45996 

-54.39427 

-31.89384 

43.10759 

65.60801 

88.20391 

101.85870 

114.35894 

123.60264 

5.60687 

5.60687 

5.60687 

5.60687 


L 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 


M 

0 . 000000 
0.000000 
0.000000 

0.156435 
0.156435 
0.156435 
0.156435 
0.156435 
0.156435 
0.156435 
0.156435 
0.156435 
0.156435 
0.156435 
0.156435 
0 . 156435 
0.156435 
0.156435 
0.156435 
0.156435 


X 

0.00000 

0.00000 

0.00000 

0.00000 
0 . 00000 
0.00000 
0.00000 
0.00000 
0.00000 
0.00000 
0.00000 
0.00000 
0.00000 
0 . 00000 
0.00000 
0.00000 
121.67773 
110 . 00210 
85.17441 
62.50119 


Y 

125.00238 

125.00238 

112.50214 

4.40677 

-99.19891 

-85.59495 

-78.09481 

-68.11722 

-51.84431 

-29.34388 

38.15741 

60.65784 

80.65822 

86.90834 

94.40848 

106.90872 

4.40677 

4.40677 

4.40677 

4.40677 


L 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 

0.000000 


M 

0.000000 
0 . 000000 
0 . 000000 

0.190809 

0.190809 

0 .190809 

0 . 190809 

0.190809 

0.190809 

0.190809 

0 . 190809* 

0.190809 

0.190809 

0.190809 

0.190809 

0.190809 

0.190809 

0.190809 

0.190809 

0.190809 


LDT NASA TELESCOPE AT 820NM WAVELENGTH File ldtplas 
ZOOM POSITION 1 
EFL = 625.007 

OPTIMIZATION CONDITIONS 
ANGLE SOLVE OFF 

EFL BACK FOCUS Ybar Mbar' Track Glass 


10:09:03 


02-14-1991 


Length Th-ness 
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WEIGHTING FACTORS 



1 

.60 25 

.00 

0.00 

500.00 

625. 

000 0. 

000 

0.0000 

0.0000 

RAY NO 

LABEL 

WT 

WT 

WT 

1 

P 

4.0 



2 

MD 

10.0 

100.0 


3 

M 

10.0 

100.0 


4 

CD 

4.0 

4.0 

150.0 

5 

MD 

10.0 

100.0 


6 

M 

10.0 

100.0 


7 

M 

10.0 

100.0 


8 

M 

10.0 

100.0 


9 

M 

10.0 

100.0 


10 

M 

10.0 

100.0 


11 

M 

10.0 

100.0 


12 

M 

10.0 

100.0 


13 

M 

10.0 

100.0 


14 

M 

10.0 

100.0 


15 

M 

10.0 

100.0 


16 

MD 

10.0 

100.0 


17 

S 

10.0 

10.0 

100.0 

18 

s 

10.0 

10.0 

100.0 

19 

s 

10.0 

10.0 

100.0 

20 

s 

10.0 

10.0 

100.0 


0.00 1.00 0.00 

0.000 209.000 0.000 


0 . 00TARGE 

0.000 


# 

VARIABLES 


CURVE 

EDGE 

CLR RAD LIMIT 

1 



0.00000 

0.000 

428.302 

2 

CEA4A6A8A10 


0.00214 

2.000 

200.000 

3 

C 


0.00354 

12.700 

200.000 

4 

CEA4A6A8A10 


0.00432 

1.000 

200.000 

5 

C 

D 

0.00063 

12.700 

428.302 

6 

CEA4A6A8A10 

D 

0.00659 

2.000 

428.302 

7 

C 

D 

0.00278 

13.000 

200.000 

8 

C 


0.00449 

1.000 

200.000 

9 

C 


0.00751 

12.700 

428.302 

10 



0.00000 

0.000 

200.000 

11 



0.00000 

70.000 

18000.000 

12 



0.00000% 

-40000.000 

12000.000 

13 



0.00000% 

-40000.000 

428.302 


ZOOM POSITION 2 
EFL = 625.007 

OPTIMIZATION CONDITIONS 
ANGLE SOLVE OFF 


EFL 

BACK 

FOCUS 

Ybar Mbar' 

Track Glass 

Length 

WEIGHTING FACTORS 




1 

.60 25 

.00 

0.00 500.00 

0.00 1.00 

0 . 00 

625. 

000 0. 

000 

0.0000 0.0000 

0.000 209.000 

0.000 

RAY NO 

LABEL 

WT 

WT WT 



21 

PZ 

4.0 




22 

MD 

10.0 

100.0 



23 

M 

10.0 

100.0 



24 

CD 

4.0 

4.0 150.0 




Th-ness 
0 . OOTARGETS 
0.000 
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25 

MD 

10.0 

100.0 


26 

M 

10.0 

100.0 


27 

M 

10.0 

100.0 


28 

M 

10.0 

100.0 


29 

M 

10.0 

100.0 


30 

M 

10.0 

100.0 


31 

M 

10.0 

100.0 


32 

M 

10.0 

100.0 


33 

M 

10.0 

100.0 


34 

M 

10.0 

100.0 


35 

M 

10.0 

100 . 0 


36 

MD 

10.0 

100 . 0 


37 

S 

10.0 

10.0 

100.0 

38 

S 

10.0 

10.0 

100 . 0 

39 

s 

10.0 

10.0 

100.0 

40 

s 

10.0 

10.0 

100.0 


# VARIABLES 
1 
2 

3 

4 

5 

6 

7 

8 
9 

10 

11 

12 

13 


CURVE 

EDGE 

CLR RAD LIMIT 

0.00000 

0.000 

428 . 302 

0.00214 

2.000 

200.000 

0 . 00354 

12.700 

200.000 

0.00432 

1.000 

200.000 

0 . 00063 

12.700 

428.302 

0.00659 

2 . 000 

428.302 

0.00278 

13.000 

200.000 

0.00449 

1.000 

200.000 

0.00751 

12.700 

428.302 

0.00000 

0.000 

200.000 

0.00000 

70.000 

18000.000 

0.00000% 

-40000 . 000 

12000.000 

0 . 00000% 

-40000 . 000 

428.302 


ZOOM POSITION 3 
EFL = 625.007 

OPTIMIZATION CONDITIONS 
ANGLE SOLVE OFF 


EFL 

BACK 

FOCUS 

Ybar 

WEIGHTING FACTORS 


1 

.60 25 

.00 

0.00 

625. 

000 0. 

000 

0.0000 

RAY NO 

LABEL 

WT 

WT 

41 

PZ 

4.0 


42 

MD 

10.0 

100.0 

43 

M 

10.0 

100 . 0 

44 

CD 

4.0 

4.0 ] 

45 

MD 

10.0 

100.0 

46 

M 

10.0 

100.0 

47 

M 

10.0 

100 . 0 

48 

M 

10.0 

100.0 

49 

M 

10.0 

100.0 

50 

M 

10.0 

100.0 

51 

M 

10.0 

100.0 

52 

M 

10.0 

100.0 

53 

M 

10.0 

100.0 

54 

M 

10.0 

100.0 

55 

M 

10.0 

100.0 


Mbar' Track Glass 

500.00 0.00 1.00 

0.0000 0.000 209.000 

WT 

150.0 


Length Th 
0.00 0 
0.000 I 


ness 

00TARGETS 

.000 
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56 

MD 

10.0 

100.0 


57 

S 

10.0 

10 . 0 

100 . 0 

58 

S 

10.0 

10.0 

100.0 

59 

S 

10.0 

10.0 

100.0 

60 

S 

10.0 

10.0 

100 . 0 


# VARIABLES 
1 
2 

3 

4 

5 

6 

7 

8 
9 

10 

11 

12 

13 


CURVE 

0.00000 

0.00214 

0.00354 

0.00432 

0.00063 

0.00659 

0.00278 

0.00449 

0.00751 

0.00000 

0.00000 

0 . 00000 % 

0 . 00000 % 


EDGE 

0.000 

2.000 

12.700 

1.000 

12.700 

2.000 

13.000 

1.000 

12.700 

0.000 

70.000 

40000.000 

40000.000 


CLR RAD LIMIT 
428.302 
200.000 
200.000 
200.000 
428.302 
428.302 
200.000 
200.000 
428.302 
200.000 
18000.000 
12000.000 
428.302 


ZOOM POSITION 4 
EFL = 625.007 

OPTIMIZATION CONDITIONS 
ANGLE SOLVE OFF 

EFL BACK FOCUS Ybar Mbar' Track Glass 


WEIGHTING FACTORS 
1.60 25.00 

o 

o 

o 

625. 

000 0. 

000 

0 . 0000 

RAY NO 

LABEL 

WT 

WT 

61 

62 

PZ 

MD 

4.0 

10.0 

100.0 

63 

M 

10.0 

100.0 

64 

CD 

4.0 

4.0 

65 

MD 

10.0 

100.0 

66 

M 

10.0 

100.0 

67 

M 

10.0 

100.0 

68 

M 

10.0 

100.0 

69 

M 

10.0 

100.0 

70 

M 

10.0 

100.0 

71 

M 

10.0 

100.0 

72 

M 

10.0 

100.0 

73 

M 

10.0 

100.0 

74 

M 

10.0 

100.0 

75 

M 

10.0 

100.0 

76 

MD 

10.0 

100.0 

77 

S 

10.0 

10.0 

78 

S 

10.0 

10.0 

79 

S 

10.0 

10.0 

80 

S 

10.0 

10.0 


500.00 0.00 1.00 
0.0000 0.000 209.000 

WT 


150.0 


100.0 
100 . 0 
100.0 
100.0 


Length Th 
0.00 0 
0.000 


# VARIABLES 
1 
2 

3 

4 


CURVE EDGE 

0.00000 0.000 

0.00214 2.000 

0.00354 12.700 

0.00432 1.000 


CLR RAD LIMIT 
428.302 

200.000 

200.000 

200.000 


ness 

00 TARGETS 
.000 
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5 

6 

7 

8 
9 

10 

11 

12 

13 


0.00063 

0.00659 

0.00278 

0.00449 

0.00751 

0.00000 

0.00000 

0 . 00000 % 

0 . 00000 % 


12.700 
2 . 000 

13.000 

1.000 

12.700 

0.000 

70.000 
-40000.000 
-40000.000 


428.302 

428.302 

200.000 

200.000 

428.302 

200.000 

18000.000 

12000.000 

428.302 


4 
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General Lens Specifications 

Total Integrated Scatter < 1 % per surface 
Surface Roughness < .005 microns rms 

Wavelengths of operation .82 microns and .86 microns 
Wedge angle < 6 arc minutes 
All aspheric surfaces: 

Slope angle within .0005 radians of nominal value defined by 
surface equation for all points within clear aperture. 

Slope angle to be measured over .5 inch span. 

Figure deviation h — . 0075 inches max from nominal curve. 


PERSPECTIVE DISPLAYS, INC. 


Sheet 1 of 1 
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LDT NASA TELESCOPE ELEMENT 001 SURFACE 1 
Sag. vs. radial distance from optical axis 


M.L.Pund 12/04/90 
Perspective Displays, 
Inc . 


z = (C* (R**2 ) ) / ( 1+sqrt ( 1- ( 1+K) * (C**2)*(R**2) ) ) + A4*(R**4) + A6*(R**6) 
+ A8* (R**8 ) + A10* ( R**10 ) 


C = 

K = 

A4 = 
A6 = 
A8 = 
A10 = 


2 . 1350000E— 03 /mm 
2 . 4779850E+00 
4 . 47959 10E-09 
-8 . 7438320E-14 
1 . 9360090E-18 
-3.5570550E-23 


Radius of Curvature 
Conic constant 

Fourth order aspheric coefficient 
Sixth order aspheric coefficient 
Eighth order aspheric coefficient 
Tenth order aspheric coefficient 


radial distance 
Sag. (mm) 

from optical axis 

(mm) 

R 

Z 

R 

(mm) 

(ram) 

( inches ) 

0 . 0000000 

0.0000000 

0.0000000 

1.2700000 

0.0017218 

0.0500000 

2.5400000 

0.0068874 

0.1000000 

3.8100000 

0.0154978 

0.1500000 

5.0800000 

0.0275541 

0.2000000 

6.3500000 

0.0430584 

0.2500000 

7.6200000 

0.0620131 

0., 3000000 

8.8900000 

0.0844211 

0.3500000 

10.1600000 

0.1102861 

0.4000000 

11.4300000 

0.1396120 

0.4500000 

12.7000000 

0.1724034 

0.5000000 

13.9700000 

0.2086656 

0.5500000 

15.2400000 

0.2484042 

0.6000000 

16.5100000 

0.2916254 

0.6500000 

17.7800000 

0.3383359 

0.7000000 

19.0500000 

0.3885430 

0.7500000 

20.3200000 

0.4422546 

0.8000000 

21.5900000 

0.4994790 

0.8500000 

22 . 8600000 

0.5602249 

0.9000000 

24.1300000 

0.6245019 

0.9500000 

25.4000000 

0.6923198 

1.0000000 

26.6700000 

0 . 7636890 

1.0500000 

27.9400000 

0.8386204 

1.1000000 

29.2100000 

0.9171256 

1.1500000 

30.4800000 

0.9992164 

1.2000000 

31.7500000 

1.0849053 

1.2500000 

33.0200000 

1.1742053 

1.3000000 

34.2900000 

1.2671299 

1.3500000 

35.5600000 

1.3636930 

1 . 4000000 

36.8300000 

1.4639091 

1.4500000 


Z 

( inches) 
0.0000000 
0.0000678 
0.0002712 
0.0006101 
0.0010848 
0.0016952 
0.0024415 
0.0033237 
0.0043420 
0.0054965 
0.0067875 
0.0082152 
0.0097797 
0.0114813 
0 .0133203* 
0.0152970 
0.0174116 
0.0196645 
0.0220561 
0.0245867 
0.0272567 
0.0300665 
0.0330166 
0.0361073 
0.0393392 
0.0427128 
0.0462286 
0.0498870 
0.0536887 
0.0576342 
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LDT NASA TELESCOPE ELEMENT 001 SURFACE 1 
R Z 

(mm) (mm) 


38.1000000 

39.3700000 

40.6400000 

41.9100000 

43.1800000 

44.4500000 

45.7200000 

46.9900000 

48.2600000 

49.5300000 

50.8000000 

52.0700000 

53.3400000 

54.6100000 

55.8800000 

57.1500000 

58.4200000 

59.6900000 

60.9600000 

62.2300000 

63.5000000 

64.7700000 

66.0400000 

67.3100000 

68.5800000 

69.8500000 

71.1200000 

72.3900000 

73.6600000 

74.9300000 

76.2000000 

77.4700000 

78.7400000 

80.0100000 

81.2800000 

82.5500000 

83.8200000 

85.0900000 

86.3600000 

87.6300000 

88.9000000 

90.1700000 

91.4400000 

92.7100000 

93.9800000 

95.2500000 

96.5200000 


1.5677931 
1.6753606 
1.7866275 
1.9016101 
2.0203255 
2.1427910 
2.2690245 
2.3990443 
2.5328694 
2.6705190 
2.8120130 
2.9573715 
3.1066154 
3.2597659 
3.4168445 
3.5778736 
3.7428757 
3.9118738 
4.0848917 
4.2619532 
4.4430829 
4.6283059 
4.8176474 
5.0111336 
5.2087907 
5.4106457 
5.6167260 
5.8270594 
6.0416742 
6.2605993 
6 . 4838641 
6.7114983 
6.9435324 
7.1799971 
7 . 4209238 
7.6663445 
7.9162915 
8.1707978 
8.4298968 
8.6936227 
8.9620098 
9.2350935 
9.5129094 
9.7954937 
10.0828834 
10.3751158 
10.6722290 


R 

( inches ) 

1.5000000 

1.5500000 

1.6000000 

1.6500000 

1.7000000 

1.7500000 

1.8000000 

1.8500000 

1.9000000 

1.9500000 

2.0000000 

2.0500000 

2.1000000 

2.1500000 

2.2000000 

2.2500000 

2.3000000 

2.3500000 

2.4000000 

2.4500000 

2.5000000 

2.5500000 

2.6000000 

2.6500000 

2.7000000 

2.7500000 

2.8000000 

2.8500000 

2.9000000 

2.9500000 
3.0000000 

3.0500000 
3.1000000 

3.1500000 
3.2000000 

3.2500000 

3.3000000 

3.3500000 

3.4000000 

3.4500000 

3.5000000 

3.5500000 

3.6000000 

3.6500000 

3.7000000 

3.7500000 

3.8000000 


FINAL REPORT 


Z 

( inches ) 
0.0617241 
0.0659591 
0.0703397 
0.0748665 
0 . 0795404 
0.0843618 
0.0893317 
0.0944506 
0.0997193 
0.1051385 
0.1107092 
0.1164320 
0.1223077 
0.1283372 
0.1345214 
0.1408612 
0.1473573 
0.1540108 
0.1608225 
0.1677934 
0.1749245 
0.1822168 
0.1896712 
0.1972887 
0.2050705 
0.2130175 
0.2211309 
0.2294118 
0.2378612 
0.2464803 
0.2552702 
0.2642322 i 
0.2733674 
0.2826771 
0.2921624 
0.3018246 
0.3116650 
0.3216850 
0.3318857 
0.3422686 
0.3528350 
0.3635864 
0.3745240 
0.3856494 
0.3969639 
0.4084691 
0.4201665 
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NASA TELESCOPE 

ELEMENT 001 SURFACE 

1 


R 

Z 

R 

z 

(mm) 

(mm) 

( inches ) 

( inches) 

97.7900000 

10.9742615 

3.8500000 

0.4320575 

99.0600000 

11.2812528 

3.900000(^ 

0.4441438 

100.3300000 

11.5932425 

3.9500000 

0.4564269 

101.6000000 

11.9102712 

4.0000000 

0.4689083 

102.8700000 

12.2323800 

4.0500000 

0.4815898 

104.1400000 

12.5596106 

4.1000000 

0.4944729 

105.4100000 

12.8920055 

4.1500000 

0.5075593 

106.6800000 

13.2296077 

4.2000000 

0.5208507 

107.9500000 

13.5724609 

4.2500000 

0.5343489 

109.2200000 

13.9206095 

4.3000000 

0.5480555 

110.4900000 

14.2740986 

4.3500000 

0.5619724 

111.7600000 

14.6329739 

4.4000000 

0.5761013 

113.0300000 

14 . 9972818 

4.4500000 

0.5904442 

114.3000000 

15.3670695 

4.5000000 

0.6050027 

115.5700000 

15.7423847 

4.5500000 

0.6197789 

116.8400000 

16.1232761 

4.6000000 

0.6347746 

118.1100000 

16.5097928 

4.6500000 

0.6499918 

119.3800000 

16.9019848 

4.7000000 

0.6654325 

120.6500000 

17.2999027 

4.7500000 

0.6810985 

121.9200000 

17.7035978 

4.8000000 

0.6969920 

123.1900000 

18.1131224 

4.8500000 

0.7131151 

124.4600000 

18.5285290 

4.9000000 

0.7294696 

125.7300000 

18.9498714 

4.9500000 

0.7460579 

127.0000000 

19.3772036 

5.0000000 

0.7628820 

128.2700000 

19.8105806 

5.0500000 

0.7799441 

129.5400000 

20.2500581 

5.1000000 

0.7972464 

130.8100000 

20.6956923 

5.1500000 

0.8147910 

132.0800000 

21.1475403 

5.2000000 

0.8325803 

133.3500000 

21.6056597 

5.2500000 

0.8506165 

134.6200000 

22.0701091 

5.3000000 

0.8689019 

135.8900000 

22.5409475 

5.3500000 

0.8874389 

137.1600000 

23.0182344 

5.4000000 

0.9062297 i 

138.4300000 

23.5020304 

5.4500000 

0.9252768 

139.7000000 

23 . 9923965 

5.5000000 

0.9445825 

140.9700000 

24 . 4893941 

5.5500000 

0.9641494 

142.2400000 

24.9930855 

5.6000000 

0.9839797 

143.5100000 

25.5035334 

5.6500000 

1.0040761 

144 . 7800000 

26.0208013 

5.7000000 

1.0244410 

146.0500000 

26.5449529 

5.7500000 

1.0450769 

147.3200000 

27.0760527 

5.8000000 

1.0659863 

148.5900000 

27.6141656 

5.8500000 

1.0871719 

149.8600000 

28.1593568 

5.9000000 

1.1086361 

151.1300000 

28.7116922 

5.9500000 

1.1303816 

152.4000000 

29.2712379 

6.0000000 

1.1524109 

153.6700000 

29.8380606 

6.0500000 

1.1747268 

154.9400000 

30.4122272 

6.1000000 

1.1973318 

156.2100000 

30.9938049 

6.1500000 

1.2202285 
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LDT NASA TELESCOPE ELEMENT 001 SURFACE 1 


R 

(mm) 

157.4800000 

158.7500000 

160.0200000 

161.2900000 

162.5600000 

163.8300000 

165.1000000 

166.3700000 

167.6400000 

168.9100000 

170.1800000 

171.4500000 

172.7200000 

173.9900000 

175.2600000 

176.5300000 

177.8000000 

179.0700000 

180.3400000 

181.6100000 

182.8800000 

184.1500000 

185.4200000 

186.6900000 

187.9600000 

189.2300000 

190.5000000 

191.7700000 

193.0400000 

194.3100000 

195.5800000 

196.8500000 


Z 

(mm) 

31.5828613 

32.1794643 

32.7836820 

33 . 3955826 

34.0152346 

34.6427067 

35.2780678 

35.9213866 

36.5727323 

37.2321740 

37.8997810 

38.5756226 

39.2597682 

39.9522875 

40.6532503 

41.3627265 

42.0807865 

42.8075008 

43 . 5429407 

44 .2871778 

45.0402847 

45.8023347 

46.5734024 

47.3535638 

48.1428967 

48.9414810 

49.7493992 

50.5667367 

51 . 3935826 

52.2300305 

53 . 0761789 

53.9321325 


R 

( inches ) 
6.2000000 
6.2500000 
6.3000000 
6.3500000 
6.4000000 
6.4500000 
6.5000000 
6.5500000 
6.6000000 
6.6500000 
6.7000000 
6.7500000 
6.8000000 
6.8500000 
6.9000000 
6.9500000 
7.0000000 
7.0500000 
7.1000000 
7.1500000 
7.2000000 
7.2500000 
7.3000000 
7.3500000 
7.4000000 
7.4500000 
7.5000000 
7.5500000 
7.6000000 
7.6500000 
7.7000000 
7.7500000 


z 

(inches) 
1.2434197 
1 . 2669080 
1 . 2906961 
1.3147867 
1.3391825 
1.3638861 
1.3889003 
1.4142278 
1.4398714 
1.4658336 
1.4921174 
1.5187253 
1 . 5456602 
1 . 5729247 
1.6005217 
1.6284538 
1.6567239 
1.6853347 
1.7142890 
1.7435897 
1.7732396 
1.8032415 
1.8335985 
1.8643135 
1.8953896 
1.9268300 
1.9586378 
1.9908164 
2.0233694 
2.0563004 
2.0896133 
2.1233123 * 
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LDT NASA TELESCOPE ELEMENT 002 SURFACE 1 
Sag. vs. radial distance from optical axis 


M.L.Pund 12/04/90 
Perspective Displays, 
Inc. 


Z = (C* (R**2 ) )/( 1+sqrt ( l-( 1+K )*(C**2)*(R**2))) + A4*(R**4) + A6*(R**6) 
+ A8*(R**8) + A10* ( R**10 ) 1 


c = 

4. 3240000E-03 

K = 

-1 . 2475900E+00 

A4 = 

1 . 9018980E-11 

A6 = 

7 . 8000490E-14 

A8 = 

-1.6354920E-18 

A10 = 

2 . 5101750E-23 


Radius of Curvature 
Conic constant 

Fourth order aspheric coefficient 
Sixth order aspheric coefficient 
Eighth order aspheric coefficient 
Tenth order aspheric coefficient 


R - radial distance from optical axis (mm) 
Z = Sag. (mm) 


R 

Z 

(mm) 

( mm) 

0.0000000 

0.0000000 

1.2700000 

0.0034871 

2.5400000 

0.0139483 

3.8100000 

0.0313833 

5.0800000 

0.0557918 

6.3500000 

0.0871732 

7.6200000 

0.1255269 

8.8900000 

0.1708519 

10.1600000 

0.2231474 

11.4300000 

0.2824121 

12.7000000 

0.3486447 

13.9700000 

0.4218439 

15.2400000 

0.5020080 

16.5100000 

0.5891354 

17.7800000 

0.6832241 

19.0500000 

0.7842722 

20.3200000 

0.8922775 

21.5900000 

1 . 0072379 

22. 8600000 

1.1291508 

24.1300000 

1.2580140 

25.4000000 

1.3938246 

26.6700000 

1.5365801 

27.9400000 

1.6862775 

29.2100000 

1.8429140 

30.4800000 

2.0064866 

31.7500000 

2.1769920 

33.0200000 

2.3544272 

34.2900000 

2.5387887 

35.5600000 

2.7300733 

36.8300000 

2 . 9282775 


R 

z 

( inches) 

( inches ) 

0.0000000 

0.0000000 

0.0500000 

0.0001373 

0.1000000 

0.0005491 

0.1500000 

0.0012356 

0.2000000 

0.0021965 

0.2500000 

0.0034320 

0.3000000 

0.0049420 

0.3500000 

0.0067265 

0.4000000 

0.0087853 

0.4500000 

0.0111186 

0.5000000 

0.0137262 

0.5500000 

0.0166080 

0.6000000 

0.0197641 

0 . 6500000 

0.0231943 

0.7000000 

0.0268986 * 

0 . 7500000 

0.0308769 

0.8000000 

0.0351290 

0.8500000 

0.0396550 

0.9000000 

0.0444548 

0 . 9500000 

0.0495281 

1.0000000 

0.0548750 

1.0500000 

0.0604953 

1.1000000 

0.0663889 

1.1500000 

0.0725557 

1.2000000 

0.0789955 

1.2500000 

0.0857083 

1.3000000 

0.0926940 

1.3500000 

0.0999523 

1.4000000 

0.1074832 

1 . 4500000 

0.1152865 
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R 

( nun ) 

Z 

(mm) 

R 

( inches ) 

it 

( inches ) 

38.1000000 

3.1333977 

1.5000000 

0.1233621 

39.3700000 

3.3454305 

1.5500000 

0.1317099 

40.6400000 

3.5643722 

1.6000000 

0.1403296 

41.9100000 

3.7902190 

1.6500000 

0.1492212 

43 . 1800000 

4.0229674 

1.7000000 

0.1583845 

44.4500000 

4.2626135 

1.7500000 

0.1678194 

45.7200000 

4.5091536 

1.8000000 

0.1775257 

46.9900000 

4.7625838 

1.8500000 

0.1875033 

48.2600000 

5.0229004 

1.9000000 

0.1977520 

49 . 5300000 

5.2900993 

1.9500000 

0.2082716 

50.8000000 

5.5641769 

2.0000000 

0 . 2190621 

52.0700000 

5.8451293 

2.0500000 

0.2301232 

53 . 3400000 

6.1329526 

2.1000000 

0.2414548 

54.6100000 

6.4276429 

2.1500000 

0.2530568 

55.8800000 

6.7291965 

2.2000000 

0.2649290 

57.1500000 

7.0376095 

2.2500000 

0.2770712 

58.4200000 

7.3528782 

2.3000000 

0.2894834 

59.6900000 

7.6749988 

2.3500000 

0.3021653 

60 . 9600000 

8.0039678 

2.4000000 

0.3151168 

62.2300000 

8.3397813 

2.4500000 

0.3283378 

63.5000000 

8.6824359 

2.5000000 

0.3418282 

64.7700000 

9.0319279 

2.5500000 

0.3555877 

66.0400000 

9.3882540 

2.6000000 

0.3696163 

67.3100000 

9.7514108 

2.6500000 

0.3839138 

68.5800000 

10.1213949 

2.7000000 

0.3984801 

69.8500000 

10.4982031 

2.7500000 

0.4133151 

71.1200000 

10.8818322 

2.8000000 

0.4284186 

72.3900000 

11.2722793 

2.8500000 

0.4437905 

73.6600000 

11.6695413 

2.9000000 

0.4594308 

74.9300000 

12.0736154 

2.9500000 

0.4753392 

76.2000000 

12.4844989 

3.0000000 

0.4915157 

77.4700000 

12.9021892 

3.0500000 

0.5079602 

78.7400000 

13.3266838 

3.1000000 

0.5246726 

80.0100000 

13.7579803 

3.1500000 

0.5416528 

81.2800000 

14 . 1960764 

3.2000000 

0.5589006 

82.5500000 

14.6409701 

3.2500000 

0.5764161 

83.8200000 

15.0926594 

3.3000000 

0.5941992 

85.0900000 

15.5511426 

3.3500000 

0.6122497 

86 . 3600000 

16.0164179 

3.4000000 

0.6305676 

87.6300000 

16.4884839 

3.4500000 

0.6491529 

88.9000000 

16.9673392 

3.5000000 

0.6680055 

90.1700000 

17.4529827 

3.5500000 

0.6871253 

91.4400000 

17.9454135 

3.6000000 

0.7065123 

92.7100000 

18.4446306 

3.6500000 

0.7261666 

93.9800000 

18.9506336 

3.7000000 

0.7460879 

95.2500000 

19.4634220 

3.7500000 

0.7662765 

96.5200000 

19.9829955 

3.8000000 

0.7867321 
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R 

(mm) 

97.7900000 

99.0600000 
100.3300000 
101.6000000 
102.8700000 
104.1400000 
105.4100000 
106.6800000 
107.9500000 
109.2200000 
110.4900000 
111.7600000 
113.0300000 
114.3000000 
115.5700000 
116.8400000 
118.1100000 
119.3800000 
120.6500000 
121.9200000 
123.1900000 
124.4600000 
125.7300000 
127.0000000 
128.2700000 
129.5400000 
130.8100000 
132.0800000 
133.3500000 
134.6200000 
135.8900000 
137.1600000 
138.4300000 
139.7000000 
140.9700000 
142.2400000 
143.5100000 
144.7800000 
146 . 0500000 
147.3200000 
148.5900000 
149.8600000 
151.1300000 
152.4000000 
153.6700000 
154.9400000 
156.2100000 


Z 

(mm) 

20 . 5093543 

21.0424985 

21.5824286 

22.1291451 

22.6826492 

23.2429418 

23.8100244 

24.3838987 

24.9645667 

25.5520306 

26.1462930 

26.7473567 

27.3552250 

27.9699013 

28.5913895 

29.2196940 

29.8548193 

30.4967706 

31.1455533 

31.8011733 

32.4636372 

33.1329518 

33.8091245 

34.4921634 

35.1820771 

35.8788747 

36.5825660 

37.2931617 

38.0106730 

38.7351120 

39.4664913 

40.2048249 

40 . 9501272 

41.7024138 

42.4617014 

43.2280075 

44.0013511 

44.7817520 

45.5692317 

46.3638127 

47.1655192 

47.9743767 

48.7904124 

49.6136553 

50.4441361 

51.2818873 

52.1269437 


1 

R 

( inches ) 

3.8500000 

3.9000000 

3.9500000 
4.0000000 

4.0500000 
4.1000000 

4.1500000 
4.2000000 
4.2500000 
4.3000000 
4.3500000 
4.4000000 
4.4500000 
4.5000000 
4.5500000 
4.6000000 
4.6500000 
4.7000000 
4.7500000 
4.8000000 

4.8500000 

4.9000000 

4.9500000 
5.0000000 

5.0500000 
5.1000000 

5.1500000 
5.2000000 
5.2500000 
5.3000000 
5.3500000 
5.4000000 
5.4500000 
5.5000000 
5.5500000 
5.6000000 
5.6500000 
5.7000000 
5.7500000 
5.8000000 

5.8500000 

5.9000000 

5.9500000 

6.0000000 

6.0500000 
6.1000000 

6.1500000 


z 

( inches ) 
0.8074549 
0.8284448 
0.8497019 
0.8712262 
0.8930177 
0.9150764 
0.9374025 
0.9599960 
0 . 9828570 
1.0059855 
1.0293816 
1.0530455 
1.0769774 
1.1011772 
1.1256453 
1.1503817 
1.1753866 
1.2006603 
1.2262029 
1.2520147 
1.2780960 
1.3044469 
1.3310679 
1.3579592 
1.3851211 
1.4125541 
1.4402585 
1.4682347 
1.4964832 
1.5250044 
1.5537989 
1.5828671 * 
1.6122097 
1.6418273 
1.6717205 
1.7018901 
1.7323367 
1.7630611 
1.7940642 
1.8253470 
1.8569102 
1.8887550 
1.9208824 
1.9532935 
1.9859896 
2.0189719 
2.0522419 
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LDT NASA TELESCOPE 
R 

(mm) 

157.4800000 

158.7500000 

160.0200000 

161.2900000 

162.5600000 

163.8300000 

165.1000000 

166.3700000 

167.6400000 

168.9100000 

170.1800000 

171.4500000 

172.7200000 

173.9900000 

175.2600000 

176.5300000 

177.8000000 

179.0700000 

180.3400000 

181.6100000 

182.8800000 

184.1500000 

185.4200000 

186.6900000 

187.9600000 

189.2300000 

190.5000000 

191.7700000 

193.0400000 

194.3100000 

195.5800000 

196.8500000 


ELEMENT 002 SURFACE 1 

Z 

(mm) 

52.9793419 

53.8391209 

54.7063223 

55.5809897 

56.4631699 

57.3529122 

58.2502689 

59.1552955 

60.0680506 

60.9885966 

61.9169994 

62.8533286 

63.7976581 

64.7500661 

65.7106351 

66.6794526 

67.6566109 

68.6422077 

69.6363460 

70.6391350 

71.6506897 

72.6711315 

73.7005886 

74.7391965 

75.7870976 

76.8444424 

77.9113897 

78.9881064 

80.0747686 

81.1715618 

82.2786812 

83.3963323 


R 

z 

( inches ) 

(inches) 

6.2000000 

2.0858009 

6.2500000 

2.1196504 

6.3000000 

2.1537922 

6.3500000 

2.1882279 

6.4000000 

2.2229594 

6.4500000 

2.2579887 

6.5000000 

2 . 2933177 

6.5500000 

2.3289486 

6.6000000 

2.3648839 

6.6500000 

2.4011259 

6.7000000 

2.4376771 

6.7500000 

2.4745405 

6.8000000 

2.5117188 

6.8500000 

2.5492152 

6.9000000 

2.5870329 

6.9500000 

2.6251753 

7.0000000 

2.6636461 

7.0500000 

2.7024491 

7.1000000 

2.7415884 

7.1500000 

2.7810683 

7.2000000 

2.8208933 

7.2500000 

2.8610682 

7.3000000 

2.9015980 

7.3500000 

2.9424880 

7.4000000 

2.9837440 

7.4500000 

3.0253717 

7.5000000 

3.0673775 

7.5500000 

3.1097680 

7.6000000 

3.1525499 

7.6500000 

3.1957308 

7.7000000 

3 . 2393182 

7.7500000 

3. 283320a 
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LDT NASA TELESCOPE ELEMENT 003 SURFACE 1 
Sag. vs. radial distance from optical axis 


M.L.Pund 12/04/90 
Perspective Displays, 
Inc. 


Z = (C*(R**2) )/( 1+sqrt ( 1- ( 1+K) * ( C**2 ) * (R**2 ) ) ) + A4*(R**4) + A6*(R**6) 
+ A8* ( R**8 ) + A10* (R**10 ) 

Radius of Curvature 
Conic constant 

Fourth order aspheric coefficient 
Sixth order aspheric coefficient 
Eighth order aspheric coefficient 
Tenth order aspheric coefficient 


C = 

6 . 5930000E-03 /mm 

K = 

-3 . 5479300E-01 

A4 = 

-3 . 3579450E-09 

A6 = 

1.2774210E-14 

A8 = 

-2 . 2076200E-18 

A10 = 

3 . 7341230E— 23 

R = radial 

distance from optical 


Sag. (ram) 

R 

Z 

R 

z 

(mm) 

0.0000000 

(mm) 

( inches ) 

( inches ) 

0.0000000 

0.0000000 

0.0000000 

1.2700000 

0.0053170 

0.0500000 

0.0002093 

2.5400000 

0.0212685 

0.1000000 

0.0008373 

3.8100000 

0.0478565 

0.1500000 

0.0018841 

5.0800000 

0.0850840 

0.2000000 

0.0033498 

6.3500000 

0.1329553 

0.2500000 

0.0052345 

7.6200000 

0.1914760 

0.3000000 

0.0075384 

8.8900000 

0.2606529 

0.3500000 

0.0102619 

10.1600000 

0.3404941 

0.4000000 

0.0134053 

11.4300000 

0.4310088 

0.4500000 

0.0169689 

12.7000000 

0.5322078 

0.5000000 

0.0209531 

13.9700000 

0.6441028 

0.5500000 

0.0253584 

15.2400000 

0.7667071 

0.6000000 

0.0301853 

16.5100000 

0.9000349 

0.6500000 

0.0354344 

17.7800000 

1.0441022 

0.7000000 

0.0411064 i 

19.0500000 

1.1989260 

0.7500000 

0.0472018 

20.3200000 

1.3645246 

0.8000000 

0.0537214 

21.5900000 

1.5409179 

0.8500000 

0.0606661 

22.8600000 

1.7281269 

0.9000000 

0.0680365 

24.1300000 

1.9261742 

0.9500000 

0.0758336 

25.4000000 

2.1350837 

1.0000000 

0.0840584 

26.6700000 

2.3548808 

1.0500000 

0.0927118 

27.9400000 

2.5855921 

1.1000000 

0.1017950 

29.2100000 

2.8272460 

1.1500000 

0.1113089 

30.4800000 

3.0798722 

1.2000000 

0.1212548 

31.7500000 

3.3435019 

1.2500000 

0.1316339 

33.0200000 

3.6181679 

1.3000000 

0.1424476 

34.2900000 

3.9039046 

1.3500000 

0.1536970 

35.5600000 

4 . 2007480 

1.4000000 

0.1653838 

36.8300000 

4 . 5087356 

1.4500000 

0.1775093 
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R 

Z 

R 

z 

(nun) 

(mm) 

( inches ) 

( inches ) 

38.1000000 

4.8279067 

1.5000000 

0.1900751 

39.3700000 

5.1583023 

1.5500000 

0.2030828 

40.6400000 

5.4999649 

1.6000000 

0.2165341 

41.9100000 

5.8529392 

1.6500000 

0.2304307 

43.1800000 

6.2172712 

1.7000000 

0.2447745 

44.4500000 

6.5930091 

1.7500000 

0.2595673 

45.7200000 

6 . 9802028 

1.8000000 

0.2748111 

46.9900000 

7.3789044 

1.8500000 

0.2905080 

48.2600000 

7.7891676 

1.9000000 

0.3066601 

49.5300000 

8.2110485 

1.9500000 

0.3232696 

50.8000000 

8 . 6446049 

2.0000000 

0.3403388 

52.0700000 

9.0898971 

2.0500000 

0.3578700 

53.3400000 

9.5469873 

2.1000000 

0.3758656 

54.6100000 

10.0159401 

2.1500000 

0.3943284 

55.8800000 

10.4968224 

2.2000000 

0.4132607 

57.1500000 

10.9897034 

2.2500000 

0.4326655 

58.4200000 

11.4946548 

2 . 3000000 

0.4525455 

59.6900000 

12.0117507 

2.3500000 

0.4729036 

60.9600000 

12.5410679 

2.4000000 

0.4937428 

62.2300000 

13.0826857 

2.4500000 

0.5150664 

63.5000000 

13.6366865 

2.5000000 

0.5368774 

64.7700000 

14.2031549 

2.5500000 

0.5591793 

66.0400000 

14.7821791 

2.6000000 

0.5819756 

67.3100000 

15.3738497 

2.6500000 

0.6052697 

68.5800000 

15.9782607 

2.7000000 

0.6290654 

69.8500000 

16.5955093 

2.7500000 

0.6533665 

71.1200000 

17.2256959 

2.8000000 

0.6781770 

72.3900000 

17.8689244 

2.8500000 

0.7035010 

73.6600000 

18.5253021 

2 . 9000000 

0.7293426 

74.9300000 

19.1949401 

2.9500000 

0.7557063 

76.2000000 

19.8779533 

3.0000000 

0.7825966 

77.4700000 

20.5744603 

3 . 0500000 

0.8100181 

78.7400000 

21.2845841 

3.1000000 

0.8379758 

80.0100000 

22.0084516 

3 . 1500000 

0 . 8664745 

81.2800000 

22.7461943 

3 . 2000000 

0.8955195 

82.5500000 

23.4979483 

3.2500000 

0.9251161 

83.8200000 

24 . 2638541 

3 . 3000000 

0.9552698 

85.0900000 

25.0440576 

3 . 3500000 

0.9859865 

86.3600000 

25.8387095 

3.4000000 

1.0172720 

87.6300000 

26.6479659 

3 . 4500000 

1.0491325 

88.9000000 

27.4719886 

3.5000000 

1.0815744 

90.1700000 

28.3109451 

3.5500000 

1.1146041 

91.4400000 

29.1650090 

3.6000000 

1.1482287 

92.7100000 

30.0343602 

3.6500000 

1.1824551 

93.9800000 

30.9191854 

3.7000000 

1.2172908 

95.2500000 

31.8196780 

3.7500000 

1.2527432 

96.5200000 

32 . 7360388 

3.8000000 

1.2888204 
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R 

(imn) 

97.7900000 
99.0600000 
100.3300000 
101.6000000 
102.8700000 
104.1400000 
105.4100000 
106.6800000 
107.9500000 
109 . 2200000 
110.4900000 
111.7600000 
113.0300000 
114.3000000 
115.5700000 
116.8400000 
118.1100000 
119.3800000 
120.6500000 
121.9200000 
123.1900000 
124.4600000 
125.7300000 
127.0000000 
128.2700000 
129.5400000 
130.8100000 
132 . 0800000 
133.3500000 
134.6200000 
135.8900000 
137.1600000 
138.4300000 
139.7000000 
140.9700000 
142.2400000 
143.5100000 
144.7800000 
146.0500000 
147.3200000 
148.5900000 
149.8600000 
151.1300000 
152.4000000 
153.6700000 
154.9400000 
156.2100000 


ELEMENT 003 SURFACE 1 

Z 

(mm) 

33.6684763 
34.6172067 
35.5824549 
36.5644543 
37.5634479 
38.5796880 
39.6134375 
40.6649700 
41.7345704 
42.8225357 
43.9291755 
45.0548131 
46.1997858 
47.3644459 
48.5491620 
49.7543193 
50.9803214 
52 . 2275909 
53.4965709 
54.7877263 
56.1015454 
57.4385411 
58.7992532 
60.1842501 
61.5941305 
63.0295265 
64.4911051 
65.9795719 
67.4956735 
69.0402010 
70 . 6139938 
72.2179436 
73.8529990 
75.5201704 
77.2205360 
78.9552475 
80.7255380 
82.5327290 
84.3782406 
86.2636005 
88.1904564 
90.1605892 
92.1759279 
94.2385673 
96.3507883 
98.5150815 
100.7341746 


R 

z 

( inches) 

( inches ) 

3.8500000 

1.3255306 

3.9000000 

1.3628822 

3.9500000 

1.4008841 

4.0000000 

1.4395454 

4.0500000 

1.4788759 

4.1000000 

1.5188854 

4.1500000 

1.5595842 

4.2000000 

1.6009831 

4.2500000 

1.6430933 

4.3000000 

1.6859266 

4.3500000 

1.7294951 

4.4000000 

1.7738115 

4.4500000 

1.8188892 

4.5000000 

1.8647420 

4.5500000 

1.9113843 

4.6000000 

1.9588315 

4.6500000 

2.0070993 

4.7000000 

2.0562044 

4.7500000 

2.1061642 

4.8000000 

2.1569971 

4.8500000 

2.2087223 

4.9000000 

2.2613599 

4.9500000 

2.3149312 

5.0000000 

2.3694587 

5.0500000 

2.4249658 

5.1000000 

2.4814774 

5.1500000 

2.5390199 

5.2000000 

2.5976209 

5.2500000 

2.6573100 

5.3000000 

2.7181181 

5.3500000 

2.7800785 

5.4000000 

2.8432261 

5.4500000 

2.9075984 

5.5000000 

2.9732351 

5.5500000 

3.0401786 

5.6000000 

3.1084743 

5.6500000 

3.1781708 

5.7000000 

3.2493200 

5.7500000 

3 . 3219780 

5.8000000 

3 . 3962047 

5.8500000 

3.4720652 

5.9000000 

3.5496295 

5.9500000 

3.6289735 

6.0000000 

3.7101798 

6.0500000 

3.7933381 

6.1000000 

3.8785465 

6.1500000 

3.9659124 
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R 

Z 

R 

z 

(mm) 

(mm) 

( inches ) 

( inches ) 

97.7900000 

33.6684763 

3.8500000 

1.3255306 

99.0600000 

34.6172067 

3.9000000 

1 . 3628822 

100.3300000 

35.5824549 

3.9500000 

1.4008841 

101.6000000 

36.5644543 

4.0000000 

1.4395454 

102.8700000 

37.5634479 

4.0500000 

1.4788759 

104.1400000 

38.5796880 

4.1000000 

1.5188854 

105.4100000 

39.6134375 

4 . 1500000 

1.5595842 

106.6800000 

40.6649700 

4.2000000 

1.6009831 

107.9500000 

41.7345704 

4.2500000 

1.6430933 

109.2200000 

42.8225357 

4.3000000 

1.6859266 

110.4900000 

43.9291755 

4.3500000 

1.7294951 

111.7600000 

45.0548131 

4.4000000 

1.7738115 

113.0300000 

46 . 1997858 

4 . 4500000 

1 . 8188892 

114.3000000 

47.3644459 

4.5000000 

1.8647420 

115.5700000 

48.5491620 

4.5500000 

1.9113843 

116.8400000 

49.7543193 

4.6000000 

1.9588315 

118.1100000 

50.9803214 

4.6500000 

2.0070993 

119.3800000 

52.2275909 

4.7000000 

2.0562044 

120.6500000 

53.4965709 

4.7500000 

2.1061642 

121.9200000 

54.7877263 

4.8000000 

2.1569971 

123.1900000 

56.1015454 

4.8500000 

2.2087223 

124.4600000 

57.4385411 

4.9000000 

2.2613599 

125.7300000 

58.7992532 

4.9500000 

2.3149312 

127.0000000 

60.1842501 

5.0000000 

2.3694587 

128.2700000 

61.5941305 

5.0500000 

2.4249658 

129.5400000 

63.0295265 

5.1000000 

2.4814774 

130.8100000 

64.4911051 

5.1500000 

2.5390199 

132.0800000 

65.9795719 

5.2000000 

2.5976209 

133.3500000 

67.4956735 

5.2500000 

2.6573100 

134.6200000 

69.0402010 

5.3000000 

2.7181181 

135.8900000 

70 . 6139938 

5 . 3500000 

2.7800785 

137.1600000 

72.2179436 

5.4000000 

2.8432261 i 

138.4300000 

73.8529990 

5.4500000 

2.9075984 

139.7000000 

75.5201704 

5.5000000 

2.9732351 

140.9700000 

77.2205360 

5.5500000 

3.0401786 

142.2400000 

78.9552475 

5.6000000 

3.1084743 

143.5100000 

80.7255380 

5.6500000 

3.1781708 

144.7800000 

82.5327290 

5.7000000 

3.2493200 

146.0500000 

84 . 3782406 

5.7500000 

3.3219780 

147.3200000 

86 . 2636005 

5.8000000 

3.3962047 

148.5900000 

88.1904564 

5.8500000 

3.4720652 

149.8600000 

90.1605892 

5.9000000 

3.5496295 

151.1300000 

92 . 1759279 

5.9500000 

3.6289735 

152.4000000 

94.2385673 

6.0000000 

3.7101798 

153.6700000 

96.3507883 

6.0500000 

3.7933381 

154.9400000 

98.5150815 

6.1000000 

3.8785465 

156.2100000 

100.7341746 

6.1500000 

3.9659124 
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R 

(mm) 

157.4800000 

158.7500000 


Z 

(mm) 

103.0110648 

105.3490575 


R 

( inches ) 
6.2000000 
6.2500000 


z 

( inches ) 
4.0555537 
4.1476007 
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APPENDIX B 


COMPLETE ELECTRONIC SCHEMATICS 


System Electronics Layout 

Page 

B3 

Angle Processor Electronics 

B4 

Quadrant Detector Electronics 

B5 

Wideband Amplifier 

B6 

Motor Switching (Ch 1) 

B7 

Motor Switching (Ch 2) 

B8 

Motor Switching (Ch 3) 

B9 

Relay Card Miscellaneous Circuit 

BIO 

Ch 1 Cable from Relay Card to Disk Assy 

Bll 

Ch 2 Cable from Relay Card to Disk Assy 

B12 

Ch 3 Cable from Relay Card to Disk Assy 

B13 

Receiver Electronics Interconnect 

B14 

Rec. Power Distribution to Custom Cable 

B15 

RS232 & Sync Pulse Interconnect Card 

B16 

Single Channel Driver Circuit (Ch 1, typical) 

B17 

Demonstration Test Aid 

B18 

Laser Diode Driver Card 

B19 

OMA 6-axis Motion Control Card (Sh 1-6) 

B20-B25 
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APPENDIX C 


COMPLETE SOFTWARE LISTINGS 


Program 

Page 

COMPUTE.C 

C3 

DISCRETE.C 

C5 

DISPLAY.C 

C9 

FILE.C 

C25 

INITMOT.C 

C30 

MANUAL.C 

C34 

MENU.C 

C36 

MONITOR.C 

C42 

MOTCNT.C 

C47 

MOTOR.C 

C61 

NEWMOT.C 

C70 

SERL.C 

C78 

TRACK.C 

C82 

AZEL.DAT 

C91 

INPUT.DAT 

C92 

ADSYS.DSP 

C93 

ALGORTHM.DSP 

C95 

BANDFILT.DSP 

C99 

LOWPASS.DSP 

C102 

MAIN.DSP 

C104 

UART.DSP 

C112 

ATTBLK.FCB 

C117 

CIRCBLK.FCB 

Cl 18 

DISCBLK.FCB 

C119 

FOVBLK.FCB 

C120 

MISCBLK.FCB 

C121 

ORBITBLK.FCB 

022 

SAVEBLK.FCB 

023 

ALDLDLAB.FOR 

024 

ANGLEPR.FOR 

026 

ARKTNS.FOR 

029 

ASGNMFN.FOR 

030 

AZELALDL.FOR 

034 

BLKDATA.FOR 

035 

CNTRLFN.FOR 

036 

COPYVEC.FOR 

043 

CROSS.FOR 

044 

DFQ.FOR 

045 

DISCPOS.FOR 

046 

DOT.FOR 

049 

ELSTAT.FOR 

050 

GAUSCL.FOR 

051 

GAUSS.FOR 

052 

INTRFACE.FOR 

053 
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COMPLETE SOFTWARE LISTINGS (cont’d) 


Program 

INV3X3.FOR 

NAVIGFN.FOR 

NAVIGPR.FOR 

OMA.FOR 

QFITVAL.FOR 

RNDM.FOR 

RUK.FOR 

SCANGN.FOR 

SCENEPR.FOR 

TRUTHGN.FOR 

UNIT.FOR 

VLEN.FOR 

XKEP.FOR 

XYAZEL.FOR 


Page 

C159 

C160 

C162 

C164 

C165 

C167 

C168 

C169 

C171 

C174 

C176 

C177 

C178 

C179 
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1 

2 /* Compute. C: Contains alt programs for computing Azimuth and Elevation 

3 numbers*/ 

4 

5 #include <stdio.h> 

6 #include <conio.h> 

7 ^include <ctype.h> 

8 #include <time.h> 

9 ^include <graph.h> 

10 #include <dos.h> 

11 #include <time.h> 

12 #include <math.h> 

13 ^include <float.h> 

14 

15 #def ine PI 3.141592654 

16 

17 /* Compute_Az_El computes azimuth and elevation parameters based on 

18 motor encoder positions StepA and StepB Reflect the positions of the 

19 of DiskA and DiskB*/ 

20 

21 Compute_AZ_EL (long int StepA, long int Step8, 

22 int Print to screen, double *Az El, double *Alpha Delta) 

23 C 

24 double Gear_ratio, Count s_per_degree; 

25 double T angle, alpha, del ta, Theta; 

26 double Pie 180 = 3.141592654/180; 

27 

28 /* 354 teeth per gear with 2000 motor encoder counts per one 360 degree 

29 motor shaft rotation. 4.640 (in.) is the radius of the drive drum and 

30 1.70(in) is the radius of the pivot point */ 

31 

32 Count s_per_degree = (354. 0/360. 0)*2000.0; 

33 Gear ratio = Counts _per degree /(4. 640/1 .70); 

34 

35 Tangle = 0.0; 

36 Tangle = sin( 1 .21 1 116e-05 * (fabs((double)StepB - (double)StepA) ) ); 

38 alpha = 90.0 + (((double)StepA - (double)$tepB)/Gear_rat io); 

39 Alpha_Delta [0] = alpha; 

40 delta = ((double)StepA / Counts _per_degree); 

41 Alpha_Del ta Cl] = delta; 

42 

43 if (alpha >= 90.0) 

44 Theta = (3.141592654/2.0) + acos(Tangle) - (delta * Pie_180); 

45 else 

46 Theta = (3.141592654/2.0) - acos(Tangle) - (delta * Pie 180); 

47 

48 Az_El[0] = atanl(0.5427 * Tangle * cos(Theta)); /* Compute A2 error */ 

49 Az E t C 1 3 = atanl(0.5427 * Tangle * sin(Theta)); /* Compute Elevation error */ 

50 

51 if (Print_to screen == 1) 

52 < 

53 pri ntf ("\n IstepA = %9li IstepB = %9li", StepA, StepB); 

54 printf ("\n Delta = %7.4f Deg. Alpha = %7.4f Deg. ", delta, alpha); 

55 printf ("\n T = %10.8f Rad. Theta = %10.7f Rad. 1 ', Tangle, Theta); 

56 printf ( M \n Azimuth = %10.8f Rad. Elevation = %10.8f Rad.", 

57 Az_El [0] ,Az_El [1] ); 

58 printf ("\n Azimuth = %10.7f Deg. Elevation = X10. 7f Deg.», 

59 Az_El [0] *57.29577951 ,Az_El [13*57.29577951); 

60 printf("\n\n"); 

61 Wait forJcey_Press( ); 

62 ~> 

63 > 

64 

65 /* Compute_Az_E l computes azimuth and elevation parameters based on 

66 X and Y position in millimeters */ 

67 

68 Compute_Az_E l_From XY (double x, double y, int Print results, double *AzEl) 

69 

70 { 

71 AzEl [0] = atan((x/1 16.0) * 0.194380309); 

72 AzEl [13 = atan((y/116.0) * 0.194380309); 

73 
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if (Print_results == 1) 

< 

printf ("\n X = %7.4f mm, Y = %7.4f mn M ,x,y); 

printf ("\n Azimuth = %10.8f. Elevation = %10.8f», AzEl CO) ,AzE mis- 
print f^VAn"); 

Uai t_for_key_Press( ); 

> 

> 

/★ Function AzE 12AB computes disk positions from azimuth and elevation V 
void AzEl2AB(double Azimuth, double Elevation, 
long int *DiskA, long int *DiskB, 
double *Delta, double *Alpha, 
int *Number_of_Solut ions) 

C double theta; 

double Ratio; 

int Array, Alt_element; 

theta=atan2(tan(Elevation),tan( Azimuth)); 

Rat io=sqrt((pow(tan( Azimuth), 2) ♦ pow(tan( Elevation), 2)))/(2.0*1 .396*tan(11 .0*PI/180.0)) 


Delta[0]=90. 0+180. 0/PI * (-theta + acos(Ratio)); 

Alpha [03=90.0+360. 0/P I * asin(Ratio); 

Delta[1]=90. 0-180. 0/PI * (theta + acos(Ratio)); 

Alpha[1]=90. 0-360. 0/PI * asin(Ratio); 

if (fabs(Delta[03 >240.0)) 

if (Delta[03 < 0) Delta[0] = Delta[03 + 360.0; 
else Delta[0] = DeltaCO] - 360.0; 

> 

if (f abs(Delta [1] >240.0)) 
i 

if (Delta [13 < 0) Delta[13 = DeltaCI) + 360.0; 
else Delta [13 = Delta [13 - 360.0; 

> 

Alt_element = 2; 
if (fabs(Delta[03 ) >= 120) 

if (Delta[03 < 0) DeltaCAl t_element] = Delta[03 + 360.0; 
else Delta [A l t_el ement] = Delta[03 - 360.0; 

A l pha [A l t_e l ement) = Alpha [03; 

Alt_element = Alt_element + 1; 

> 

if (fabs(Del ta[1] ) >= 120) 
i 

if (Del ta Cl 3 < 0) Del ta[Alt_element] = DeltaCI) + 360.0; 

else Delta [A l t_e l ement] = DeltaCI) - 360.0; 
Alpha[Alt_element) = Alpha[1]; 

Alt element = Alt_element + 1; 

“ > 

for (Array = 0; Array <= Alt_element-1; Array++) 
t 

DiskA [Array] =( long int) < 1966. 6666666667* (Del taCArr ay] )); 
DiskB [Array] =( long int) (1966.6666666667*(Delta[Array) ) 

- 720. 5459770*(( Alpha [Array] )-90)); 

> 

*Number_of_Solutions = Alt_element - 1; 
return; 
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/* discrete. C: controls all functions of the dc servo motors */ 

#include <stdio.h> 

^include <conio.h> 

#include <ctype.h> 

#include <time.h> 

#inctude <graph.h> 

#include <dos.h> 

#include <time.h> 

/* Mask_bit array is used to mask off bits that are not needed for test 
these will be for switches 1-18 */ 
int Mask_bit [19] = {0x00,0x00,0x00, 

0x40,0x80,0x20, 

0x10,0x00,0x00, 

0x04,0x08,0x02, 

0x01,0x00,0x00, 

0x40,0x80,0x20, 

0x10}; 

int Activation_bi t [19] = {0x00,0x00,0x00, 

0x40,0x80,0x00, 

0x00,0x00,0x00, 

0x04,0x08,0x00, 

0x00,0x00,0x00, 

0x40,0x80,0x00, 

0x00}; 


int I ndex_Mask_bi t [7] = {0x0000,0x0004,0x0008,0x2000, 
0x1000,0x8000,0x4000}; 

int Detect_Bi t 5V = {0x01}; 
int Detect~Bi t~12V = {0x02}; 

int Sync_Pulse_Oetect [31 = {0x0600,0x0500,0x0300}; 

int Sync_pu l s e_da t a [ 1 6] = {0,0, 0,3, 0,2, 1 , 0,0,0, 0,0, 0,0,0,0}; 

int Sync_N umber; 


extern unsigned Port_A_Address; 
extern unsigned Port_B_Address; 
extern unsigned Port~C_Address; 
extern unsigned Port_373; 


/* Address of port A on 8255 */ 

/* Address of port B on 8255 */ 

/* Address of port C on 8255 */ 

/* Address for the input post 373*/ 


/* Declare the following variables external these var. are declared in motor. c */ 
extern unsigned Motor_Pai r1_Address; /*Address to first pair of motor controllers */ 

extern unsigned Motor_Pai r2_Address; /*Address to first pair of motor controllers */ 

extern unsigned Motor_Pai r3_Address; /*Address to first pair of motor controllers */ 

extern Set_to_actual; 

unsigned Port_Address; /* Varible used to store address of 

port to be read or written to */ 

int elaspedtime = 0; 


/* Function used to test for switch activation */ 
int Check_for_swi tch_Act ivation( int Switch Number) 

int Detec t_count = 0; 
int Switch'data = 0; 
int Swi tch_detect = 0; 
int read_loop; 

if ( (Swi tch_Number >= 0) && (Swi tch_Nuriber <= 14)) 
Port_Address = Port_A_Address; 
else 

Port_Address = Port_B_Address; 

Swi tch_data = inp(Port_Address) & Hask^bi t [Swi tchJJunfcer] ; 
Detect_count = 0; 
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if (Switch data == Acti vation_bi t [Swi tchJJumber] ) 

S* Delay reading the switch position for x amount of time V 
for (elaspedt ime = 20000; elaspedtime > 0; elaspedtime = elaspedtime - 

for (read_loop = 1; read_loop <= 3; read_loop ♦+) 

{ * 

/* Delay reading the switch position for x amount of time */ 

for (elaspedtime = 5000; elaspedtime > 0; elaspedtime = elaspedtime 
Switch data = inp(Port_Address) & Mask_bi t [Switch_Number] ; 

if (Switch_data -= Act i vation_bi t [Swi tch_Number] ) 

* Detect_count = Detect_count+1 ; 

> /* End of for (read_loop = 1; read_loop <= 3; read_loop +♦) */ 

/* If switch was closed for 3 reads indicate that switch closure 
was detected V 

if (Detect_count == 3) 

Swi tch_detect = 1; 

else SwTtch_detect = 0; - ^ 

> /* End of (Switch_data == Acti vat ion^bit [Switch_Number] ) / 

return Swi tch_detect; 

> /* End of function Check_for_swi tch_Activation */ 

/* Run_Switch_Bit will be used to test the switches to see which ones 
are act Waited */ 

int Run_$wi tch_B i t ( i nt Channel_to_test, int Display_output) 

int Number_of_Swi tch [12] ={3,4, 5, 6, 9, 10, 1 1 , 12, 15, 16, 17, 18}, 

int Act_swi tch = 0; 

int Swi tch_f lag = 0; 

int loop_count = 0; 

int Start, End; 

float Channel_number; 

if (Channel_to_test == 1) 

Start = 0; End = 3; Channeljumber = 2.5; 

> 

else if (Channel_to_test == 2) 

Start = 4; End = 7; Channel_nunber = 1.0; 

> 

else 

{ Start = 8; End = 11; Channel_number = 4.0; 

> 

for (Loop_count = Start; Loop_count <= End; Loop_count++) 

Act_swi tch = Check_f or_swi tch_Act i vat i on(Number_of_Sw i tch [Loop_count3 ) 
if (Act_switch == 1) 

* printf ("XnSwitch %i activated \n", Number_of_Switch[Loop_count] ) 
Switchjflag = 1; 

> 

> /* End of for loop_count */ 

if ((Switch_f lag == 0) && (Display_output == D) 

pri ntf ("\n No Switches found to be activated on Channel X2.1f\n", 
Chennel_number); 

return Switch_flag; 

> /* End of function Run_Swi tch_Bi t V 

/* check_for Index_Mark checks for the occurs of an index mark V 


FILE: D:\TEMP\DISCRETE.C p age; c7 

Size: 7305 Edited: 9-01-92, 4:52p Printed: 11-17-92, 1:43p 


int Check_for_Index_Mark( int Motorjiunber) 


int Index_data = 0; 
int Index_detect = 0; 

if ( (Motor_Number == 1 > 1 1 (Motor Number == 2)) 

Port_Address = Port B Address; 
else 

Port_Address = Port_373; 

Index_data = inpw(Port_Address) & Index_Mask_bit [Mot or_N umber] ; 
if (Index data == 0) 

< 

/* Delay reading the switch position for x amount of time */ 
for (elaspedtime = 1000; elaspedtime > 0; elaspedtime = elaspedtime - 1 

Index_data = inpw(Port_Address) & Index Mask_bit [Motor Hunker } • 
if (Index_data == 0) 

Index_detect = 1; 

> 

return Index_detect; 

> /* End of function Check for index mark */ 

176 " " 

177 /* Function checks for to see if 5v supply is on V 

178 int Check_for_5Vol ts(void) 

179 < 

180 

181 int VoltJ)ata = 0; 

182 int Active 5Volts = 0; 

183 

184 Port_Address = Port B Address; 

185 

186 Volt_Data = inpw(Port Address) & Detect Bit 5V* 

187 " - “ ' 

188 if (Volt_Data == Detect_Bi t_5V) 

189 Acti ve__5Volts = 1; 

190 return Active 5VoLts; 

191 > 

192 

193 /* Function checks for to see if +24v supply is on */ 

194 int Check_for_24Vol ts( void) 

195 < 

196 

197 int Volt_Data = 0; 

198 int Active_24Vol ts = 0; 

199 

200 Port_Address = Port B Address; 

201 

202 Vol t_Data = inpw(Port Address) & Detect Bit 12V- 

203 ‘ “ “ ' 

204 if (Vol t_Data == Detect_Bi t_12V) 

205 Active_24Vol ts =1; 

206 return ActTve_24Vol ts; 

207 > 

208 

209 int Check for Motor Power(void) 

210 C " - - 

211 int option_key; 

212 int loop; 

213 int exit= 0; 

214 char key_buf fer [80] ; 

215 int Pwr_On24 , Pwr_On5 = 0; 

216 Pwr_On24 = Check2for_24Volts< ); 

217 Pwr 0n5 = Check for 5Volts<); 

218 “ ’ " 

219 if ((Pwr On24 != 1) II (Pwr 0n5 != 1)) 

220 c 

221 /* Set all position registors to actual position before turning power V 
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Set_Motor_Posi t ion(Motor_Pai r1_Address,Set_to_actual ); 

Set Hot or_Pos i t i on<Mot or_Pa i r2_Address , Set_to_actual ) ; 

Set~Motor_Position(Motor_Pair3_Address,Set_to_actual); 

while ( (Pwr_On24 != 1) && (Pwr_On5 != D) 

/* Clear screen and ask for what channel we need to change V 
_clearscreen( _GCLEARSCREEN ); /* Clear screen for next output / 
_settextposition(1 ,1 ); 

pr i ntf ("\n No Power to motor detected\n"); 

printf ("\n1 . Turn on digital amd motor power and press 'I 1 to continue \n ); 
printf ( M \n2. Exit to main menu \n"); 

printf ( H \nSelect the one of the above options\n M ); 
opt i on_key ■ -1; /* Reset value key value V 

do 

gets( key buffer); 

option key = atoi (key_buffer); 

> while "((option Jcey <= 0) || (option_key > 2)); 

if (option_key == 2) 

C 

exit = 1; break; 

> 


Pwr_On24 = Check_for_24Vol ts( ); 

Pwr_On5 = Check_for_5Vol ts( ); 

> /* end of while (Power-On != 1)*/ 

> 

return exit; 

> 

/* Function Check_for_Act i ve_Syr»c_Pulse checks for active sync pulse */ 
i nt Check_for_Act i ve_Sync_PuTse( voi d) 

C 


Sync_N umber = ( inpw(Port_373) & OxOFOO) » 8; 
return Sync_pulse_data[$ync_Nunber3 ; 



FILE: D:\TEHP\DISPLAY.C p age . c9 

Size: 33589 Edited: 9-01-92, 4:53p Printed: 11-17-92, 1:43p 


1 

2 

3 

4 

5 

6 

7 

8 
9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 
21 
22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

32 

33 

34 

35 

36 

37 

38 

39 

40 

41 

42 

43 

44 

45 

46 

47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 
61 
62 

63 

64 

65 

66 

67 

68 

69 

70 

71 

72 

73 


/* Display routine is used to provide the menu for manual control of the motors */ 

^include <stdio.h> 

#include <conio.h> 

#include <ctype.h> 

#include <time.h> 

#include <graph.h> 

^include <dos.h> 

#include <time.h> 

#include <stdlib.h> 


/* Declare the following variables external these var. are declared 


extern unsigned Motor_Pair1_Address; 
extern unsigned Motor_Pai r2~Address; 
extern unsigned Motor_Pai r3_Address; 
extern unsigned Control_word_address; 
extern unsigned Port_A_Address; 
extern unsigned Port_B~Address; 
extern unsigned Port_C_Address; 
extern unsigned Port_373; 
extern int Set_to_actual; 
extern int Reset_to_zero; 
extern long int Starting_Position[2] [3] ; 
extern long int Current_Posi t i on C23 [3] ; 
extern double Azimuth[3] , Elevation [3] ; 
double Cur rent^Az i muth , Current JE l eva t i on; 


in motor. c */ 


/♦Address to first pair of motor controllers 

/♦Address to first pair of motor controllers 

/♦Address to first pair of motor controllers 

/* Address of Control word on 8255 */ 

Address of port A on 8255 */ 

Address of port 8 on 8255 ♦/ 

Address of port C on 8255 */ 

Address of 74LS373 input port */ 


*/ 

♦/ 

V 


int Stop_Serial_Data[3] = L0xFFBF,0xFF7F,0xFFEF>; 
int Ini t iate_Serial_Tran[3] = {0x40,0x80,0x10}; 

long int timelasped = 2000000; /* Variable for delay function */ 

int Channel_number; /♦ Number of channel to be selected */ 

int Error = 0; /* Variable used for receiving error number */ 

int Passed_check; 

extern int C_Port_Data; 

int Step,Menu_opt ion, Ini tial_a l ignment, loop, Solution; 

long int DiskAstep,DiskBstep,Power_on; 

double E l_Az [2] ; 

double Alpha_Del ta[2] ; 

doub l e T emp_Az i mut h [3] ; 

double Temp_E levat ion [3] ; 

double Stop_point; 


/* Array of data used to read in RS232 data back from the DSP */ 
extern struct Channel data 

unsigned Time_tag; 
double V_error; 
double U_error; 
double Signa ^strength- 
signed char Transmi t_Data; 

) Channel [3] , Test [3] ; 


void Wai t_for_key_Press( void); 

void P rocess_Ma i n_0pt i on (int Key_pressed); 

int D i sp l ay_Ma i n_Menu( void) ; 


char key_buf fer [80] ; 
extern FILE *Manual_test_ptr; 
extern FILE *AzEl_Ptr; 


int Display_Main_Menu(void) 
t 

int key; 

/♦Print the main menu to the screen ♦/ 


_clearscreen( ^GCLEARSCREEN ); 

_settextposi ti on( 1 , 1 ); /*Position the cursor at position 1,1)*/ 
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printfC " 


** MANUAL CONTROL MENU 


printfC "1. Set mode of motor control lersXn"); 

printfC "2. Read Status registor\n"); 

printfC "3. Write to analog portXn"); 

printfC "4. Write to PWM portXn"); 

printfC "5. Set sampler timerXn"); 

printfC "6. Set digitial filter parametersXn"); 

printfC "7. Read digitial filter parametersXn"); 

printfC "8. Set motor acceleration^'’); 

printfC "9. Set motor veloci ty\n"); 

printfC "10. Read motor acceleration^"); 

printfC "11. Read max motor veloci ty\n"); 

printfC ”12. Read actual position of motorXn"); 

printfC "13. Clear position registor Xn"); 

printfC "14. Write final position to controller \n"); 

printfC "15. Read final position to controller \n"); 

printfC "16. Write command position to controller Xn"); 

printfC "17. Read comnand position to controller \n"); 

printfC "18. Run motor in trapezoidal mode \n»); 

printfC "19. Read input discretes \n"); 

printfC "20. Align channelXn"); 

_settextpositionC3,42); 
printfC "21. Move optics arm"); 

_settextposi tionC4,42); 

printfC "22. Exercise channel through limits"); 

set textpos i t i onC5 , 42 ) ; 
printfC "23. Test safety switches"); 

set textpos i tionC6,42); 
printfC "24. Test serial link 
settextposi tionC7,42); 
printfC "25. Test PC to PC serial link "); 

settextposi tionC8, 42); 
printfC "26. Backlash test "); 

settextposi tionC9,42); 
printfC "27. Step response test "); 

_set textpos i tionC 10,42); 
printfC "28. Eccentricity test "); 

settextposi tionC 1 1 ,42); 
printfC "29. Compute Azimuth & Elevation "); 
settextposi tionC 12,42); 

printfC "30. Change Starting Azimuth & Elevation"); 

_settextposi tionC 13,42); 

printfC "31. Exercise multiple channels"); 

_set textpos i tionC 14,42); 

printfC "32. Reset motor controllers"); 

settextposi tionC 15,42 ); 
printfC "33. Check power supply discretes"); 
_settextpos i t i onC 16,42); 

printfC "34. Move arm to designated Az and El"); 

_set textpos i tionC 17,42); 

printfC "35. Select channels to run"); 


**\nXn" ) ; 


settextposi tionC23, 1 ); 

printfC'Select the one of the above optionsXn"); 
key =0; /* Reset value key value */ 

/* Read in data from the keyboard that is an interger format */ 


getsC key_buffer); 
key = atoi Ckey_buffer); 

if CkeyJxifferCO] == 'e') Close_downO; 

/* jest to see if it is within range of menu values V 
while CCkey <= 0) [ | Ckey > 35)) 

C 

getsC key_buffer); 

key = atoi(key_buffer); 

if Ckey^buf fer [0] == 'e') Close_down( ); 

> 

return key; 

> 
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/* Output the main menu to the screen and make a selection */ 
i nt D i sp l ay_Secondary_Menu( void) 

{ 

int key; 

int Command_opt i ons [15] = L0, 21 ,34,22,31 ,29, 20, 23, 24,25, 33,26, 27,28,32}; 
/*Pr int the main menu to the screen */ 

_clearscreen( _GCLEARSCREEN ); 

_settextposi tion(1 , 1 ); /^Position the cursor at position 1,1)*/ 

printf ( ■■ ** MANUAL CONTROL MENU **\n\n H ); 

printf( M * Move Channel Commands *\n"); 

printf ( "1. Move optics arm delta & alpha i nc remen t\n M ); 
printf( "2. Move arm to designated Az and El\n"); 
printf ( "3. Exercise single channel through limits\n"); 
printf ( "4. Exercise all channels through limits\n"); 
printf ( “5. Compute channel Az & El\n\n M ); 

printf( 11 * Alignment Command *\n"); 

printf ( '*6. Channel al ignment\n\n M ); 

printf( " * System Test Commands *\n M ); 

printf ( "7. Motor safety switch test\n"); 

printf ( "8. DSP to PC serial link test\n"); 

printf ( "9. Host PC to Monitoring PC serial link test\n H ); 

printf( "10. Power monitoring discrete test\n"); 

printf ( “11. Motor drive backlash test \n"); 

printf( "12. Motor step response test \n">; 

printfC *• 1 3 . Channel eccentricity test \n H ); 

printf( "14. Reset Motor Command"); 


_settextposi t ion(23, 1); 

printf C"Se l ect the one of the above options\n"); 
key =0; /* Reset value key value */ 

/* Read in data from the keyboard that is an interger format */ 

gets( key_buffer); 
key = atoi (key_buf fer); 

if (key_buf fer [0] == «e') Close_down( ); 

/* Test to see if it is within range of menu values */ 
while ((key <= 0) || (key > 15)) 

C 

gets( key_buffer); 

key = atoi ( key_buf fer); 

if (key_buf fer [0] == 'e') Close_down( ); 

> 

/* The following command is used to convert secondary menu options 
to reflect options from the primary menu */ 

key = Comma nd_opt i ons [key] ; 
return key; 

> 


void Process_Main_Option (int Key_pressed) 
C 

int read_data[3] ; 

long int read_long_data [3] ; 

int write_data[3] ; 

long int wri te_long_data[3] ; 

int Address_of_Motor; 

int time,Swi tch_activated,print_results; 

char buffer [80]; 

i nt Channe l s_to_Exerc i se [4] ; 

int Channel; 
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/* Clear screen and ask for what channel we need to change V 
_clearscreen( _GCLEARSCREEN ); /* Clear screen for next output */ 

Write_system_data(); /‘Save position of motors to file */ 

if ( (Key_pressed == 19) || (Key_pressed == 30) || <Key_pressed == 35) 

|| <Key_pressed == 31) || (Key_pressed == 32) || (Key_pressed == 33)) 

settextposi t i on( 10, 1 ); /‘Position the cursor at position 1,1)*/ 
Channel_nini>er = 1; 

> 

else 

_settextposition(10,1 ); /‘Position the cursor at position 1,1)*/ 
printf ("\nEnter the nunber of the channel (1, 2, 3) "); 

gets(buffer); 

Channel = atoi (buffer); 

Channel_number = 0; 

/* set address of motor based on the input from the keyboard */ 
if (Channel == 2) 

< 

Address_of_Motor = Hotor_Pair1_Address; 

Channel_number = 1; 

> 

else if (Channel == 1) 

{ 

Address_of_Motor = Motor^Pai r2_Address; 

Channel_number = 2; 

> 

else if (Channel == 3) 

( 

Address_of_Motor = Motor_Pair3_Address; 

Channel_number = 3; 

> 

> /* End of Key_pressed != 19 */ 


/* Check to see that +24 volt power is on */ 

/* If exit was chosen jump to main menu */ 

if (<Key_pressed == 20) || (Key_pressed ==21) || (Key_pressed == 22) 

I (Key_pressed == 26) 1 1 (Key_pressed == 27) 1 1 (Key_pressed == 28) 

|| (Key_pressed == 29) || (Keyjjressed == 31) || (Keyjsressed == 34)) 

< 

Passed_check = 0; 

Passed_check = Check_for_Motor_Power( ); 
if (Passedcheck == T) Keyj>ressed = 100; 

) 


if ((Channel_number >=1) & (Chamel_number <= 3)) 
i 

switch (Key_pressed) 

case 1: /* Set control mode of motor controllers */ 

int optionjcey; 
unsigned statusword; 

printf("\n ** Select mode of operation ** \n M ); 

print f ( M \n1 . Software reset of controller \n M ); 
printf ("2. Initialization/Idle mode \n H ); 
printf("3. Align Mode \n H ); 
printf ( M 4. Control Mode \n"); 

printf ("Select the one of the above options\n"); 
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optionjcey = 0; /* Reset value key value V 

/* Read in data from the keyboard that is an integer format */ 
gets( keyjxiffer); 
opt i on_key = atoi (key_buf fer); 

/* Test to see if it is within range of menu values */ 
while ((opt ion_key <= 0) || (option_key > 4)) 

gets( key_buffer); 
option_key = atoi (key_buf fer); 

statusword = Readjstatus_reg(Address_of_Motor); 

if (option_key == 1) 

Wri te_to_program_counter(Address_of_Motor, 0x0000); 
else if (option_key == 2) 

Wri te_to_program_counter(Address_of_Motor, 0x0101 ); 
else if (option_key == 3) { 

if ((statusword & 0x2020) == 0x2020) /* Check for Idle mode */ 

Wri te_to_program_counter(Address_of_Motor, 0x0202); 
else { 

printf ("\nControl ler is not in IDLE mode. Set controller to IDLE mode to continue \n"); 
Uait_for_key_Press(); ) 

> 

else if (option_key == 4) ( 

if ((statusword & 0x2020) == 0x2020) /* Check for Idle mode V 

{ 

int 2ero[3] = {0,0,0}; 
int zero_long[3] = {0,0,0); 

/* Clear flag to disable trapoziodal move */ 

Wr i t e_to_f l ag reg i s t or ( Address_of _Motor , 0x0000 ) ; 

/* Set the controller motor control to bipolar operation */ 

Wr i te_to_f l ag_reg i stor ( Address_of_Motor , 0x0202) ; 

/* Clear flag to disable proportional velocity mode */ 

Wr i te_to_f l agregi stor (Address_of_Hotor, 0x0303); 

/* Clear flag to disable intergal velocity mode */ 

Wr i te_to_f l ag_reg i s tor ( Address_of _Motor , 0x0505 ) ; 

/* Initialize command position to 0 */ 

Write_command_pos(Address_of_Motor,zero_long); 

/•Initialize actual position to 0 V 
Reset_Ac tua l_Pos i t i on( Address_of _Motor , zero) ; 

/* Initialize final position to 0 */ 

Wri te_Fi nal_pos(Address_of_Motor,zero_long); 

Wri te_to_program_counter(Address_of_Hotor, 0x0303); 

> 

else { 

printf ( H \nContro l ler is not in IDLE mode. Set controller to IDLE mode to continue \n"); 
Wait forjcey PressO; } 

) 


break; 

> 

case 2: /* Read Status registor */ 

{ 

unsigned status; 

status = Read_status_reg(Address_of_Motor); 

printf ("\n\nVa l ue of the status registor for DiskB motor controller = %x \n", status & Oxff); 
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printf ("\nValue of the status registor for DiskA motor controller = Xx \n", status » 8) 

Wai t_f or_key_Press( ) ; 

break; 

> /* End of case 2 */ 

case 3: /* Write to analog port V 

^printf ("\nEnter the value to be outputted to the DiskB motor controller"); 
printf ("\nana log port Hex (0-FF) "); 

cscanfC "Xx", &wri te_data[0] ); 

printf ("\nEnter the value to be outputted to the DiskA motor controller"); 
printf ("\nana log port in Hex (0-FF) "); 

cscanfC "Xx", &wri te_data [1] ); 

Wri te_to_8bi t_port(Address_of_Motor, (wri te_data[0] & OxOOf f ) | (wri te_data [1] << 8)); 
break; 

} /* End of case 3 */ 


case 4: /* Write to PWM port */ 


printf C ,l \nEnter the value to be outputted to the DiskB motor controller"); 
printf ("\npwm port Hex (0-FF) "); 

cscanfC "Xx", &wri te_datat0) ); 

printf ("\nEnter the value to be outputted to the DiskA motor controller"); 
printf ("\npwm port in Hex (0-FF) "); 

cscanfC "Xx", &wri te_data[1] ); 

Wri te_to_PWM jx>r t ( Address_of_Motor , ( wr i te_data C03 & OxOOf f) | (wri te_data [1] « 8)); 
break; 

) /* End of case 4 */ 


case 5: /* Set sampler timer */ 


i 


printf ("\nEnter the value to be outputted to the timer of the controller in hex\n"); 
cscanfC "Xx", &wri te_data [0] ); 

Wri te_to_sampler_t imer(Address_of_Hotor,wri te_data[0) ); 

break; 


> /* End of case 5 V 


case 6: /* Set digitial filter parameters */ 
i 

printf ("\nSame filter parameters will be used for both' 1 ); 
printf ("\r^nter the pole for the digital filter in hex\n M ); 
cscanfC "Xx", &write_data[0] ); 

printf ("\nEnter the zero for the digital filter in hex\n»); 
cscanfC "Xx", &write_data[1] ); 

printf ("XnEnter the gain for the digital filter in hex\n"); 
cscanfC "Xx", &write_data[2] ); 

Wri te_Fi l ter_Pol e( Address__of_Hotor , wri te_data [01 ) ; 

Wr i t e_F i 1 1 er_Zero( Address”of _Motor , wr i te_data Cl ) ) ; 

Wri te~F i l ter_Gai n( Address_of "Motor , wri te_dat a [2] ) ; 
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break; /* Exit the case statement at this point */ 
> /* End of case 6 */ 


case 7: /* Read digitial filter parameters */ 


C 

/* Read filter data pack from controller*/ 
read_data[0] = Read_Fi l ter_Zero(Address_of_Motor); 
read_data[13 = Read_Fi l ter_Pole(Address_of~Motor); 
read_data[23 = Read_Fi lter_Gain(Address_of_Motor); 

printf("\n\n ** DiskB Motor Controller Filter Parameters **\n"); 

printfC* Zero of digital filter (Hex) = Xx \n», <read_data[0] & Oxff)); 

printfC Pole of digital filter (Hex) = Xx \n»,(read data[1) & Oxff)); 

printfC Gain of digital filter (Hex) = %x \n", (read“dataC2) & Oxff)); 

printf ("\n\n ** DiskA Motor Controller Filter Parameters **\n"); 

printfC Zero of digital filter (Hex) = %x \n",((read data[0] & OxffOO) »8)); 

printfC Pole of digital filter (Hex) = Xx \n", ( (read’data [1] & OxffOO) » 8)) 

printfC Gain of digital filter (Hex) = Xx \n", ((read‘data[2] & OxffOO) » 8)) 

Wai t_for_key_Press( ); /* Wait for a key to be pressed before continuing */ 

break; 


case 8: /* Set motor acceleration */ 

< 

printf C\nEnter the acceleration for DiskB motor in hex \n"); 
cscanf ( "Xx", &wri te_data [0] ); 

printf C\nEnter the acceleration for DiskA motor in hex \n ,! ); 
cscanf ( "Xx", &wri te_data [1] ); 

/* Output the values of acceleration to the controllers */ 

Wri te_Max__Accel(Address_of_Motor,wri te_data); 

break; 

> /* End of case 8 */ 


case 9: /* Set motor velocity */ 


printf C\nEnter the max velocity for DiskB motor (0-7FH) \n"); 
cscanf ( "Xx", &wr i te_data [0] ); 

printf ( M \nEnter the max velocity for DiskA motor (0-7FH) \n"); 
cscanf ( "Xx", &wri te_data [1] ); 

/* Output the velocity value to the controllers*/ 

Wri te_Max_Veloci ty(Address_of_Motor, (wri te_data [0] & 0x007f) | 

(wri te_data C13 « 8) & 0x7FFF); 


break; 

> /* End of case 9 */ 

case 10: /* Read max motor acceleration*/ 


i 


Read_Max_Acce l ( Address_of_Mot or , read data) ; 

printf ("\n DiskB motor acceleration Is set at (Hex) Xx ", read_data [0] ); 
printf ("\n DiskA motor acceleration is set at (Hex) Xx \n ",read data[1))* 
Wai t_for_key_Press( ); 

break; 

> /* End of case 10 */ 
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case 11: /* Read PWM port V 


read_data [0] = Read_Max_Velocity(Address_of_Motor); 

printf ( M \n DiskB motor max. velocity is set at (Hex) Xx^ead_data [03 & Oxff); 
printf("\n DiskA motor max. velocity is set at (Hex) Xx \n\n , read_data [0] 8), 

Wait for key_Press(); 


break; 

> /* End of case 11 V 

case 12: /*Read actual position of motor */ 


getchO; /*Clear all data out of buffer V 
timelasped = 20000; 


while( IkbhitO) /* Wait for key on keyboard to be pressed */ 

* Read_Actual_Pos(Address_of_Motor,read_long_data); 

printf ("\n DiskB motor position = Xli ", read_long_data[0] ); 
printf (" DiskA motor position = Xli ",read_lon 9- data[13 ); 

/* delay the program be requesting new data V 

for (timelasped = 20000; timelasped > 0; timelasped = timelasped - 1) 
time = time +1; 
time = 0; 

/* Use getch to throw key away. */ 
getchO; 

break; 

> /* End of case 12 */ 
case 13: 

^ Reset_Actual_Posi tion(Address_of_Motor, 0x0000); 

break; 

> /* End of case 13 */ 

case 14: /* Write final position */ 


f* Enter position to which motor will be moved to V 

printf ("\nEnter new position for DiskB motor movement - \n M ); 
gets( key buffer); 

wr i te_long_da ta [0] = atol(key_buffer); 

/★ Enter position to which DiskA motor will be moved to */ 
printf ( M \nEnter new position for DiskA motor movement - \n*'); 
gets( key buffer); 

wri te_long_data[13 = atol(key_buffer); 

/* output the final position tho the controller*/ 

Wri te_Final jx»s(Addressof - Motor ,write_long_data); 

break; 

> /* End of case 14 */ 

case 15: /* Read final position registor V 

t 


Read_F i nal_Pos( Address_of_Motor , read_long_data) ; 

printf ( n \n The final position of the DiskB motor is = Xli ", read_long_data[0] I); 
printf ("\n The final position of the DiskA motor is = Xli \n", read_lon 9- data [1] ) 


Wai t_f or_key_Press( ) ; 
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break; 

> /* End of case 15 */ 

case 16: /* Write command position */ 

C 

break; 

printf ( M \nEnter the command position to run the DiskB motor to \n»)- 
gets( key_buffer); ' 

write_long_data[0] = atol<key_buf fer); 

printf ("\nEnter the command position to run the OiskA motor to \n")- 
gets( keyjxjffer); ' 

wr i te_long_data [0] = atol(keyjxiffer); 

/* Output the command position from the controller*/ 

Wri te_command_pos(Address_of_Motor,wri te long data); 

break; 

> /* End of case 16 */ 

case 17: /* Read command position registor */ 


Read_Command_Pos(Address_of_Motor,read_long_data); 

printf(»\n The command position of the DiskB motor is = Xli ".read long data[0]V 
pnntf("\n The command position of the DiskA motor is = Xli \n",read long datarll) 
Wai t_for_key_Press( ); - - 

break; 

> /* End of case 17 */ 

case 18: /* Start motor */ 

/* Start the motor for a trapzoidel move */ 

Wri te_to_f lag_registor (Address of Motor, 0x0808)- 
break; 

> /* End of case 18 */ 

case 19: /* Read out discretes and print to the screen */ 


getchO; /*Clear all data out of buffer */ 
timelasped = 100000; 

while( IkbhitO) /* Wait for key on keyboard to be pressed V 

read_data[0] = inp(Port_A Address); 
read_data[1) = inp(Port_B“Address); 
read_data [2] = inpw(Port_373); 

printf ( M \n Port A Discretes = Xx ”, read_data [0] & Oxff); 
printf (" Port B Discretes * Xx \t Controller Port = %x M , 
read_data[1] ,read_data(2] ); 

/* delay the program be requesting new data */ 
for (timelasped = 25; timelasped > 0; timelasped = timelasped - 1) 
time = time +1; 
time = 0; 

> 

/* Use getch to throw key away. */ 
getchO; 
break; 

> /* End of case 19 */ 

case 20: /* Align selected channel */ 

C 

printf("\n ** Alignment options ** \n M ); 
printf( M \n 1.) Encoder initialization M ); 
printf("\n 2.) Initial alignment calibration M ); 
printf ("\n 3.) Exit without alignment "); 
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printf ("\n Select desired option ">; 


do { 

gets( key_buffer); 

Menu_opt i on = atoi (keyjxif fer); 

> while ( (Menu_opt ion <= 0) || (Menu_option > 3)); 


if (Menu option == 2) 

C 

Initial _a l ignment = 1; 

Set Motor Posi tionC Address of_Motor,Reset_to_zero); 

Al ign_Channel ( Address_of_Mot or, Channel .number, Imt laical ignment ); 

> 

else if ( Menu_opt i on == 1) 


Initial alignment =0; . . , 

Align Channel (Address_ofJ<o tor, Channel .number, Imt ial_al ignment ) 


> 


break; 

> 


case 21: /* Hove optics arm */ 


i 


long int Offset_Posi tion[3] ; 
long int alpha = 0; 
long int delta = 0; 

int in_range_f lag = 0; /* Flag indicating 


data inputted is in range 


V 


while ( in_range_f lag == 0) 

printf (“VnEnter change in delta position of arm \n"); 


gets( key_buffer); 
delta = atol (keyjouffer); 

printf ( M \nEnter change in alpha position of arm \n"); 


gets( keyjxiffer); 
alpha = atol(keyjxiffer); 

if ((delta <= 480) && (delta >= -480) && 

(alpha <= 40) && (alpha >= -40)) 
in_range_f lag =1; 

else printf ("\nlnval id range select again!! \n ), 

> /* End of while in_range_f lag == 0 */ 

/* Read in actual position of the DiskA and DiskB motors for offset V 
Read Actual_Pos( Address_of_Motor ,Of f set_Posi t i on) ; 


/* compute position for DiskB motor */ 

wr i te_ L ong_dat a [0] = (1967 * -delta) ♦ (alpha 


* 769) + 0ffsetj>osition[0] ; 


/* Compute position for DiskA motor command */ 

wri te_long_data[1] = Offset_Position[1] + (1967 * delta); 


/* output the final position tho the controller*/ 

Write_Final_pos(Address_of_Motor,write_long_data); 

/* Start up motors for arm movement */ 

Write to f lag_registor (Address_of_Motor ,0x0808); 
break; 

} /* End of case 21 */ 

case 22: /* Exercise channel through its limits */ 

* Exerc i se_Channe l ( Address_of _Motor , Channe l_number ) ; 
break; 

> 

case 23: /* Run test on switches for designated channel */ 
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C 

printf ("\n Switch Test Results \n"); 
print_resul ts = 1; 

Swi tch_act ivated = Run_Swi tch_Bi t (Channel _number,print_results); 

Wai t_for_key_Press( ); 

break; 

> 

case 24: /* Run test on serial link */ 

t 


Init_Com_port(); /Mnitalize serial port */ 

ComFlushRxC ); /* Flush out data before starting loop */ 

printf ("\nPower receiver electronics\n"); 

Wai t_f or_key_Press< ); 

printf( M \n\nTesting channel Xi's serial link. Please wait!\n M , 
Channel ); 

Error = Test_Serial_Link(Channel_number,C_Port_Data); 

if (Error == 0) printf ("\n\nSer ial link commini cat ions good\n"); 
ComCloseAl l ( ); 

Wai t_forJcey_Press( ); 
break; 


case 25: /* Run test on serial link */ 


Ini t_ComjDort( ); /*Initalize serial port */ 

ComF lushRx( ); /* Flush out data before starting loop */ 

printf ("\n\nHi t any key to exit option"); 

while( !kbhit(>) /* Wait for key on keyt>oard to be pressed */ 
i 

Error = Test_Serial Link(Channel_number,C_Port Data); 

> 

getchO; 

ComCloseAl l( ); 
break; 


case 26: /* Run backlash test 

pri ntf ("\n 1.) Test Backlash Disk 
printf ("\n 2.) Test Backlash Disk 
printf("\n 3.) Test Backlash Disk 
printf ("\n 4.) Test Backlash Disk 
printf ( M \n 5.) Exit test"); 
printf ("\n Select desired option 


*/ 

B channel (U_error) H ); 

A channel"); 

A & B channel together (V_error) M ); 

A & B channel in opposite directions") 


do { 

gets( keyjxiffer); 

Menu_option = atoi (key_buf fer); 

> while ((Menu_opt ion <= 0) || (Menu_option > 5)); 


if (Henu_option != 5) 
i 


I n i t_Com_por t ( ) ; /*Initalize serial port */ 

ComFlushRxO; /* Flush out data before starting loop */ 

Run_Back_Lash_T es t ( Address_of _Hotor , C_Port_Dat a , 

C h a nne l _n umbe r , M enu_op t i on ) ; 

ComCloseAl l ( ); 

) 


break; 

> 

case 27: 
C 


/* Test motor for step response */ 


FILE: D:\TEMP\DISPLAY.C pa 9 e: c20 

Size: 33589 Edited: 9-01-92, 4:53p Printed: 11-17-92, 1:43p 


814 

815 

816 

817 

818 

819 

820 
821 
822 

823 

824 

825 

826 

827 

828 

829 

830 

831 

832 

833 

834 

835 

836 

837 

838 

839 

840 

841 

842 

843 

844 

845 

846 

847 

848 

849 

850 

851 

852 

853 

854 

855 

856 

857 

858 

859 

860 
861 
862 

863 

864 

865 

866 

867 

868 

869 

870 

871 

872 

873 

874 

875 

876 

877 

878 

879 

880 
881 
882 

883 

884 

885 

886 
887 


pr intf ("\n 
printf ("\n 1 . ) 
pr intf ("\n 2. ) 
printf ("\n 3. ) 
printf ("\n 4. ) 
printf ( M \n 
printf("\n 5.) 
printf("\n 6.) 
printf ("\n 7. ) 
printf("\n 8.) 


Command move test options "); 

Test Disk B motor" ); 

Test Disk A motor"); 

Test both Disk B & A motors running in same direction"); 

Test both Disk B & A motors running in opposite direction"); 

Trapezoidal move test options "); 

Test Disk B motor"); 

Test Disk A motor"); 

Test both Disk B & A motors running in same direction"); 

Test both Disk B & A motors running in opposite direction"); 


printf ("\n 9.) Exit test"); 

printf ("\n Select desired option "); 


do { 

gets( keyjxiffer); 

Henu_option = atoi (key_buffer); 

> while <(Menu_option <= 0) || (Menu_option > 9)); 


if <Menu_option != 9) 

< 

printf ("\n Enter step response value Range 1 - 1000 counts "); 


do { 

gets( keybuffer); 

Step = atoi (key_buf fer); 

> while ((Step <= 0) || (Step > 1000)); 

fprintf (Manual_test_ptr,"\n Step response value = Xi",Step); 
Run_Step_Test(Address_of_Motor,Channel_number,Step,Menu_option); 

> /* End of if Menu_option != 4 */ 
break; 

> 


case 28: / * Run eccentricity test on gears */ 

{ 

Init_Com_port(); /*Initalize serial port */ 
ComFlushRxO; /* Flush out data before starting loop */ 

Run_Eccen_Tes t ( Address_of_Motor , C_Por t_Data , 
Channel_nLinber); 

ComCloseAl l ( ); 
break; 

> 

case 29: 
t 


E l_Az [0] = 0.0; /* Set azimuth and elevation array values to zero */ 

El_Az [1] = 0.0; 

DiskAstep = 0; 

DiskBstep = 0; 

Read_AzE l_data( ); 

/* Read data from system file on present position */ 
Read_Current_System_data( ); 


/* Store values read in program into temporary array V 
for (loop = 0; loop <= 2; loop++) 
i 

Temp_Azimuth [loop] = Azimuth [loop] ; 

Temp Elevation [loop] = Elevation [loop] ; 

> 


pr intf("\n\n *** Compute Azimuth and Elevation parameters *** \n\n") 

printf("\n 1.) Use current disks position on Channel Xi", Channel); 
printf ("\n 2.) Enter disks positions by hand for Channel Xi ", Channel ); 
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printf ( M \n 3.) Compute AZ & EL for all three channels using current 

printf ( H \n 4.) Exit option"); 

printf ("\n\n Select desired options\n">; 

do 

t 

gets( keyjouffer); 

Menu_opt i on = atoi(key buffer); 

> 

while ((Menu_opt ion <= 0) || (Menu_option > 4)); 

/* Exit case statement at this time */ 
if (Menu_option == 4) break; 

if (Henu_option == 2) 

{ 

printf ("\nEnter IstepA position for computing Az & El \n M ); 
gets( keyjouffer); 

OiskAstep = atol(keyjxjffer); 

printf < M \nEnter IstepB position for computing Az & El \n">; 
gets( keyjxjffer); 

DiskBstep = atol(key_buffer); 

printf ("\n\n Azimuth & Elevation for Channel %i», Channel ); 

Compute_AZ_EL (DiskAstep, DiskBstep, 1 , El Az, Alpha Delta); 

T emp_Az i muth [Channe l_number -1] = El Az70] *57. 2957795 1 ; 

T emp_E l eva t i on [Channe l _numbe r -1) = El Az [11*57.29577951; 


if (Menu option == 1) 

C 

DiskAstep = CurrentJ>osi t i on CD [Channe l_nuuber - 1]; 
DiskBstep = CurrentJ>osi t ion[0] [Channe l "number - 1]; 

printf ("\n\n Azimuth & Elevation for Channel %i ", Channel); 

Compute_AZ_EL (Di skAstep,DiskBstep, 1 ,El Az, Alpha Delta); 
Temp_Azimuth[Channel_number -1] = El_AzT0)*57.29577951; 
Temp_E l evat ion [Channe l_number -1] = El_Az [13*57.29577951 ; 


if (Menu_option == 3) 

< 

for (loop = 0; loop <= 2; loop++) 

C 

if (loop == 0) Channel = 2; 
else if (loop == 1) Channel = 1; 
else if (loop == 2) Channel = 3; 

DiskAstep = Current_Position[1] [loop] ; 

DiskBstep = Cur rent_Position[0] [loop] ; 

printf ("\n\n Azimuth & Elevation for Channel %i", Channel); 

Compute_AZ_EL (DiskAstep,DiskBstep, 1 ,El_Az, Alpha Delta); 
Temp_Azi muth [loop] = El Az [01*57.2957795 1; 

T emp_E l evat i on [ l oop] =eT_Az [1 ] *57. 2957795 1 ; 


> 

> 

Henu_option = 0; 

printf ("\n1 . ) Save changes to file "); 
printf("\n2. ) Continue without saving changes"); 
printf ("\n Select option\n M ); 
do 

i 

gets( key_buffer); 
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Menu_option = atoi (key_buf fer); 

while C(Henu_option <= 0) || (Menu_option > 2)); 

if (Menu_option == 1) 

C 

for (loop = 0; loop <= 2;loop++) 

C 

Azimuth [loop] = Temp_Azimuth [loop3 ; 

Elevation [loop] = Temp_Elevation[loop] ; 

> 

Wri te_AzEl_data( ); 

> 

break; 

> 


case 30: 

1 Select_Azel_Changes(); /‘Request user for new azimuth and elevation parameters*/ 
break; 

> 

case 31: 

C Channe l stoExerc i se [03 = 0; /* Disable channel */ 

Channels_to_Exercise[1) = 1; 

Channe l s_to_Exerc i se [23 = 1; 

Channe l s_to_Exerc i se [3] =1; /* Enable channel V 

Exer c i se_Mu l t i p l e_Channe l s ( Channe l s_t o_Exe re i se ) ; 
break; 


case 32: /* Reset all motor controllers to present actual position V 

Address_of_Motor = Motor _Pai r1_Addr ess; 

Set_Motor_Pos i t i on( Address_of jiotor , Set_to_actua l ) ; 

Address_of_Motor = Motor_Pair2_Address; 

Set_Motor_Posi t i on( Address_of Jiotor , Set_to_actua l ) ; 

Address_of_Motor = Motor_Pai r3_Address; 

Set_Motor_Pos i t i on( Address_of_Motor , Set_to_ac tua l ) ; 
break; 

> 

case 33: /* Check power supply */ 

i 

Power_on = Check_for_24Volts(); 
if (Power_on == T) 

printf ("\n +24 Volt power supply on"); 
else printf ("\n +24 Volt power supply off' 1 ); 

Power-on = Check_for_5Volts( ); 
if (Power on == 1) 

printf("\n +/-5 Volt power supply on\n\n"); 
else printf ("\n +/-5 Volt power supply off\n\n"); 

Wai t_for_key_Press( ); 

break; 

> 

case 34: /* Hove arm to new position */ 

< 

Menu_option = 0; 

Read_AzEl_data( ); 

/* Read data from system file on present position */ 

Read_Current_System_data( ) ; 

/* use getch to throw key away. */ 
while (kbhitO) getchO; 

printf("\n1 .) Enter absolute AZ & EL values "); 
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pr intf ( M \n2. ) Move arm with keyboard arrows"); 
printf ("\n3. ) Run scan pattern"); 
printf C"\n4. ) Exit without moving arm"); 

printf ("\n Select option\n"); 

do 

gets( key_buffer); 

Menu^option = a to i (key buffer); 

> 

while ((Menu_opt ion <= 0) || (Menu_option > 4)); 

/* Use getch to throw key away. */ 
while (kbhitO) getchO; 


if (Menu_option == 1) 

Move_to_New_AZEL ( Channe l_number , Address_of _Motor ) ; 


if ( (Menu_opt i on == 2) || (Menu_option == 3)) 


DiskAstep = Current _Posi t ion Cl] [Channel number-1]; 

DiskBstep = Current~Posi tion[0] [Channe l "number- 1] ; 

Compute_AZ_EL (DiskAstep,DiskBstep,0,El_Az, Alpha Delta); 

Cur rent_Az imuth = El_Az[0]; 

Current_Elevat ion = El_Az[1]; 

Ini t_Com_port(); /*Initalize serial port */ 

if (Menu__opt ion == 2) 

Pos i t i on( Current_Az imuth, Cur rent_E l evat i on, 

Channe l_number,Address_of_Motor7; 

else 

C 

pr intf ("\nEnter level of trip point for scan (+0.2 to +39.0 Volts)\n"); 
Stopjxnnt = 0; 

while ((Stop_point < 0.2) || (Stop_point > 39.0)) 

gets(key_buf fer); 

Stop_point = atof (key buffer); 

> 


/* Use getch to throw key away. */ 
while (kbhitO) getchO; 

Run_Scan_Pattern ( Cur rent_A z imuth, Cur rent_E l evat ion, Channe l_number, 
Address_of_Motor, Stop_point); 

> 

while (kbhitO) getchO; 

printf ("\n1 . ) Save AZ & EL values for tracking "); 
printf ( M \n2. ) Exit without saving Az & EL"); 

printf("\n Select option\n"); 

do 

gets( keyjxiffer); 

Menu_option = atoi (key_buf fer); 

> 

while ((Menu_option <= 0) || (Menu_option > 2)); 

if (Menu_option == 1) 
t 

Writ e_sys t em_da t a ( ) ; 
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Read_Current_System_data( ); 

DiskAstep = Current_Posi t i ontl] [Channel_nunber- 1] ; 
DiskBstep = Current_Posi t ion[0] [Channel_number-13 ; 

Compute AZ EL (DiskAstep, DiskBstep,O r El_Az,Alpha_Delta); 
Azimuth [Channel_number- 13 = El_Az [03 *57.29577951; 

E levat i on [Channel_number- 1 3 =E l_Az [13 *57 . 29577951 ; 

Wr i te_AzE l_data( ) ; 

Write AzE l_T rack_Data( ); 


ComCloseAllO; 

> 

break; 

> 

case 35: 

{ 

Select_Channels_to_Run( ); 

> 

default: 

break; 

> /* End of switch statement */ 

> /* End of if Channel_number >=1 ) & (Channel_number <= 3 */ 
> /* End of function Call_Routine */ 


void Wait_forJcey_Press(void) 

printf ("Press any key to continue"); 

/* Display message until key is pressed. */ 

while( IkbhitO); /* Wait for key on keyboard to be pressed */ 

/* Use getch to throw key away. */ 
whi le (kbhitO) getchO; 
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/* File.C: Used to open all nessacary files for diagonoastic */ 

^include <stdio.h> 

#include <conio.h> 

#include <ctype.h> 

#include <time.h> 

^include <dos.h> 

^include <time.h> 

#include <cport.h> 

#include <math.h> 

#include <stdlib.h> 

#include <graph.h> 

FILE *output_ptr; 

FILE *Data_Ptr; 

FILE *System_Ptr; 

FILE *AzEl_Ptr; 

Elevation data for all three channels*/ 

FILE *Track_AzEl_Ptr; /* Set up pointer for tracking par. for tracking software */ 

FILE *Align_Ptr; /* Set up pointer with alignment info */ 

FILE *Manual_test_ptr; /* Set up pointer for file to output error data */ 

FILE *InputJ>tr; /* Set up pointer for data that contains input data 

to */ 

long int Disk_Posi tionE2] ; 
long int Disk_LeoJ>osition[23 ; 
long int Starting_Posi t ion[2] [3] ; 
long int Current_Position[2] [3] ; 
long int Leo_Posi tion[2] [3] ; 
long int A l ign_Posi t ionC2] [3] ; 
double Azimuth73] ,Elevation[3] ; 
double T rack_Az C3] , T rack_E l [3] ; 
int Chan,Chan_Address; 
int Channel_data; 

/* Declare the following variables external these var. are declared in motor. c */ 
extern unsigned Motor_Pai M_Address; /*Address to first pair of motor controllers */ 

extern unsigned MotorJ>ai r2_Address; /*Address to first pair of motor controllers */ 

extern unsigned Motor_Pai r3_Address; /*Address to first pair of motor controllers */ 

extern long int OffsetJ>osi tion[3] [4] ; 
extern int Selected_Channels [3] [25 ; 

void R ead_sys t em_da t a ( vo i d ) ; 
void Open_f i les( int track); 
void Wri te_systefn_data(void); 


/* Set up pointer for file to output error data */ 

/* Set up pointer for file to output test data */ 

/* Set up pointer for file that contains system data */ 

/* Set up pointer for file that contains Azimuth & 


void Open_f i les( int track) 

< 

/* If tracking mode is used open these additional files */ 
if (track == 1) 

if ((output_ptr=fopen("c: WnasaWoutput.txt Vat") )==NULL) 

printf ("Cannot open file\n"); 
ex i t ( 1 ) ; 

> 

if ((Data_Ptr=fopen("c:\\nasa\\Test.dat ,, ,"at"))==NULL) 

C 

printf ("Cannot open file\n"); 
exit(1); 

) 

> 

/* Open only if using manual mode */ 

if (track == 0) 

C 

i f ( (Manual _test_ptr=fopen( "c : \\nasa\\manua l .dat" , "a+t" ) )==NULL ) 

< 
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printf ("Cannot open file\n"); 
exit(l); 

> 

> 

if ( (System_Ptr=f open( "c : \\nasaWSystem.dat " , 11 r+t" ) )==NULL) 

< 

printf ("Cannot open file\n">; 
exit(1); 

> 

if ( ( AzE l_P t r=f open( "c : WnasaWSysAzE L . dat " , H r+ 1 11 ) )==NULL ) 

< 

printf ("Cannot open file\n"); 
exi t ( 1 ); 

> 

if ( ( T rack_AzE l _Pt r=f open( "c : WnasaWAzE l . dat" , "r+t" ) )==NULL ) 

C 

printf ("Cannot open file\n"); 

exit(1); 


if ((AlignJ > tr=fopen("c:\\nasa\\Align.dat","r+t ,, ))==NULL) 

i 

printf ("Cannot open file\n"); 
exit(l); 

> 

if (( input_Ptr=fopen( ,, c:\\nasa\\Input.dat", ,, r+t"))==NULL) 

printf ("Cannot open file\n"); 
exit(1); 

> 


Read_system_data( ) ; 

/* Print header file for data */ 

fprintf (Data_Ptr, "\nTimeTag Sig Lev V_Error U_Error M ); 

fprintf (Data_Ptr , " ActB DiskBC IstepB ActA DiskAC 

) 

void Read_system_data(void) 

C 

rewind (System_Ptr); 

for (Chan = 0;~Chan <= 2; Chan++) 

i f scanf ( Syst em_Pt r , " %td %ld\n",&Disk_PositionEl],&Disk^Position[0]); 

Start ing_Positi on [0] [Chan] = Disk_Posi tiontO] ; 

Start ing__Positi on [1] [Chan] = Disk_Posi t ion[1] ; 

> 

for (Chan = 0; Chan <= 2; Chan++) 

{ 

fscanf (System Ptr,"%i\n",&Channel_data); 

Selected_Channels[Chan] [13 = Channeljdata; 

> 


void Read_Current_System_data(void) 

< 

rewind (System_Ptr); 

for (Chan = 0; Chan <= 2; Chan++) 

{ f scanf (System J>tr," Xld Xld\n",&Disk_Posi tiontl] ,&Disk_Posi tion[0] ); 
Current_Position[0] [Chan] - Oisk_Position[0] ; 

Current_Position[1] [Chan] = Disk_Posi tion[1] ; 

> 

> 

void Write system_data(void) 

< 


IStepA") 
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148 /* Move file point to begining of file */ 

149 rewind (System_Ptr); 

150 

151 for (Chan = 1; Chan <= 3; Chan++) 

152 { 

153 switch (Chan) 

154 { 

155 case 1: 

156 { 

157 Chan_Address = Motor Pai r1_Address; break; 

158 > 

159 case 2: 

160 C 

161 Chan_Address = Motor_Pair2 Address; break; 

162 > " 

163 case 3: 

164 { 

165 Chan Address = Motor_Pai r3_Address; break; 

166 ~> 

167 > 

168 

169 Read_Actual_Pos(Chan_Address,Disk Position); 

170 

171 Disk_Position[0] = Start ing_Posit ion [0] [Chan-1] - Disk_Position[0] ; 

172 Disk PositionM] = Start ing Posi tionCI] [Chan-1] + Disk~Position[1] ; 

173 

174 fprintf (System Ptr,"%ld %ld\n",Disk_Posi tionCI] , Disk Position[0] ); 

175 > 

176 

1 77 /* Write out data of active channels */ 

178 for (Chan = 0; Chan <= 2; Chan++) 

179 fprintf (System_Ptr, u %i\n", Selected Channels [Chan] [1] ); 

180 

181 > /* End of function Write_system data */ 

182 

183 /* Reads in data for user changing of azimuth and elevation errors*/ 

184 void Read_AzEl_data(void) 

185 C 

186 /* Move file point to begining of file */ 

187 rewind (AzEl_Ptr); 

188 

189 for (Chan = 0; Chan <= 2; Chan++) 

190 < 

191 fscanf (AzEl_Ptr, " %lf\n M ,&Azimuth [Chan] ); 

192 fscanf (AzEl_Ptr," Xlf \n*',&Elevat ionCChan] ); 

193 > 

194 > /* End of Read_AzE L__data function*/ 

195 

196 

197 

198 /* Writes out new azimuth and elevation data */ 

199 void Wri te_AzEl_data(void) 

200 < 

201 /* Move file point to begining of file */ 

202 rewind (AzEl_Ptr); 

203 

204 for (Chan = 0; Chan <= 2; Chan++) 

205 { 

206 fprintf (AzE l_Ptr, n %lf\n M , Azimuth [Chan] ); 

207 fprintf (AzEL_Ptr,'* %lf\n M , Elevation [Chan] ); 

208 ) 

209 > /* End of Write AzEl_data function */ 

210 
211 
212 

213 /* Writes out new azimuth and elevation data */ 

214 void Wri te_AzEl_Track_Data(void) 

215 < 

216 int loop = 0; 

217 double dummy = 0; 

218 int zero; 

219 int switch_channel [33 = {1,0, 2>; 

220 
221 


/* Move file point to begining of file */ 
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rewind (Track_AzEl_Ptr); 

for (Chan = 0; Chan <= 2; Chan++) 

< 

if (Selected_Channels£switch_channel [Chan]] [1] != 0) 
i 

f pr i nt f ( T rack_AzE l _P t r , " 21 f \n" , Az i mut h [swi tch_channe l [Chan] ] ) ; 
fprintf(Track_AzEl_Ptr, M 21 f \n",E levat ion[switch_channel [Chan]] ); 
loop*-+; 

> 

> 

if (loop < 3) 
i 

for (zero = 1; zero <= (3 - loop); zero++) 
t 

fprintf (Track_AzEl_Ptr," 2lf\n",dummy); 
fprintf (Track_AzEl_Ptr, *' 21 f\n", dummy); 

> 

) 

> /* End of Wri te_AzEl_data function V 


/* Writes out new Alignment Data to file*/ 
void Write Al ign_data(void) 

< 

/* Hove file point to begining of file V 
rewind (Align_Ptr); 

for (Chan = 0; Chan <= 2; Chan++) 

C 

fprintf (Al ign_Ptr," 2ld\n" f Al ignJ>osit ion[0] [Chan]); 
fprintf (Al ign~Ptr," 2ld\n",At ign_Position[1] [Chan]); 

> 

) 

/* Reads in alignment data for all channels V 
void Read_Al igndata(void) 

< 

/* Move file point to begining of file V 
rewind (Align_Ptr); 

for (Chan = 0; Chan <= 2; Chan++) 

C 

fscanf (Al ign_Ptr, " 2ld\n",&AlignJ>osition[0] [Chan] ); 
fscanf (Al ign_Ptr, M 2ld\n",&Al ign_Posi t ion[1] [Chan] ); 

) 

> 

void Change_Input_Data(void) 
i 

/* Create and open temporary file. */ 

FILE *outf i le; 
char tmp[120] ; 

int loop, l ine_count, Channel s_To_Run; 
outfile = tmpfileO; 

/* Get each line from input and write to output. V 
for (line count =1; line_count <= 12; l ine_count++) 

C 

fgets( tmp, 120, InputPtr); 
f put s( tmp, outfile ); 

> 

Channels_To_Run = 0; 

for (loop =0; loop <= 2; loop++) 

if (Selected_Channels£loop] [1] 1= 0) 

Channel s_To_Run = Channels_To_Run +1; 


> 
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rewind (Input_Ptr); 
rewind (outfiTe); 

for ( l i ne_count = 1; line_count <= 12; line count++) 
fgets( tmp, 120, outfile); 

/* Add 48 to the number of channels to indicate the ascii char */ 
if ( l ine_count == 12) tmp[0] = Channels To Run ♦ 48- 
fputs( tmp. Input Ptr ); 

> 


> 
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/* Display routine is used to provide the menu for manual control of the motors */ 
#include <stdlib.h> 

#include <stdio.h> 

^include <conio.h> 
include <ctype.h> 

#include <time.h> 

#include <graph.h> 

#inctude <dos.h> 

^include <time.h> 

#include <math.h> 

#def i ne BLK_SZ 8 
^define Pi 3.141592654 


/* Declare the following variables external these var. are declared in "»tor.c / 
extern unsigned Motor Pair1_Address; /‘Address to first pair of motor contro ers / 

extern unsigned Motor>air2_Address; /‘Address to first pair of motor contro ers / 

extern unsigned Motor Pair3_Address; /‘Address to first pair of motor controllers / 


extern unsigned Port_A_Address; 
extern unsigned Port_B_Address; 
extern unsigned Port_C_Address; 


/* Address of port A on 8255 */ 
/* Address of port B on 8255 */ 
/* Address of port C on 8255 */ 


long int timelasped; 
int delay; 

int Reset_to_zero = 1; /* These 2 variables will be used global for setting motor position »/ 

int Set _to_actual = 0; 


struct rccoord pos; 

void Ini t ial i ze_Control lers (void); 

void Ini tialize_Cont rollers (void ) 

int Ch_num,Address_of_Channel; 

int long zero [2] = (0,0}; 

int Accel_data[2] ; 

/* Declare the digitial filer parameters V 

/* Format of the Filter pole array are as follows 
Fi lter_PoleC0] Bits 16 - 9 Channel 1 Arm motor pole 
Fi Iter PoleCOI Bits 8 - 1 Channel 1 Drun motor pole 
Fi l ter _ Pole [1] Bits 16 - 9 Channel 2 Arm motor pole 
F i l ter_Pole [13 Bits 8 - 1 Channel 2 Drum motor pole 
Filter Pole[2] Bits 16 - 9 Channel 3 Arm motor pole 
Filter~Pole[2] Bits 8 - 1 Channel 3 Drum motor pole V 

int Fi lter_Pole[3] = (0xe6e6,0xe6e6,0xe6e6>; 

/* Format of the Filter zero array are as follows 
Filter ZeroEO] Bits 16 - 9 Channel 1 Arm motor Zero 
Fi lter_Zero[0] Bits 8 - 1 Channel 1 Drum motor Zero 
Filter Zeroll] Bits 16 - 9 Channel 2 Arm motor Zero 
Filter Zero[1] Bits 8 - 1 Channel 2 Drum motor Zero 
Fi l ter^Zero [23 Bits 16 - 9 Channel 3 Arm motor Zero 
Fi Iter^Zerotf] Bits 8 - 1 Channel 3 Drum motor Zero */ 

int Fi l ter_Zero[3] = (0xd3d3,0xd3d3,0xd3d3>; 

/* Format of the Filter Gain array are as follows 
FilterJJainCO] Bits 16 - 9 Channel 1 Arm motor Gain 
Fi lter_Gain[0] Bits 8 - 1 Channel 1 Drum motor Gain 
Filter_Gain[1] Bits 16 - 9 Channel 2 Arm motor Gain 
Fi l ter_Gain[1] Bits 8 - 1 Channel 2 Drum motor Gain 
Filter Gain[2) Bits 16 - 9 Channel 3 Arm motor Gain 
Fi l ter^Gain [23 Bits 8 - 1 Channel 3 D ran motor Gain */ 

int Fi l ter_Gain(3] = (0x4040,0x9090,0x9090); 

/* Format of the Sampler_Timer array are as follows 
S ancle Time[0] Bits 16 - 9 Channel 1 Arm motor timer 
Sanple_Time[0] Bits 8 - 1 Channel 1 Drum motor timer 
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Sample_T imeCI] Bits 16-9 Channel 2 Arm motor timer 
Sampl e_T i me [1 ] Bits 8 - 1 Channel 2 Drum motor timer 
$ample_T ime [2] Bits 16-9 Channel 3 Arm motor timer 
Sample_T ime [2] Bits 8 - 1 Channel 3 Drum motor timer */ 

int Sample_T ime [3] = {0x0F0F,0x0F0F,0x0F0F}; 


/* Format of the Max_velocity array are as follows 
^ ax _Vdoci ty [0] Bits 16-9 Channel 1 Arm motor max velocity 
Max_Veloci ty [0] Bits 8 - 1 Channel 1 Drum motor max velocity 
^ a *_Vel oc i ty [1 ] Bits 16 - 9 Channel 2 Arm motor max velocity 
Max_Veloci ty [1] Bits 8 - 1 Channel 2 Drum motor max veloity 
^ ax _V©l ocity [2] Bits 16-9 Channel 3 Arm motor max velocity 
Max_Veloci ty [2] Bits 8-1 Channel 3 Drun motor max velocity */ 

int Max_Veloci ty[3] = {0x0202,0x0202,0x0303); 

/* Format of the Max_Accel array are as follows 

Max_Accel [0] Bits 16-9 Channel 1 Arm motor max Accel 

Max_Accel [1] Bits 8-1 Channel 1 Drum motor max Accel 

Max_Accel [2] Bits 16-9 Channel 2 Arm motor max Accel 

Max_Accel [3] Bits 8-1 Channel 2 Drum motor max veloity 

Max_Accel [4] Bits 16-9 Channel 3 Arm motor max Accel 

Max_Accel[5] Bits 8-1 Channel 3 Drun motor max Accel */ 

int Max_Accel [6] = {0x1000,0x1000,0x1000,0x1000,0x1000,0x1000} 

for (Ch_num = 0; Ch_num < 3; Ch num = Ch num +1) 

{ ~ 

/* Set address of motor based on loop counter */ 

if (Ch_num == 0) 

Address_of_Channel = Motor_Pai r1_Address; 

else i? (Ch_num == 1) 

Address_of_Channel = Motor_Pai r2_Address; 

else if (Ch_num == 2) 

Addr ess_of _Channe l = Motor_Pai r3_Address; 

/* Do a soft reset on the drum and motor controller of channel x */ 

Wri te_to_program_counter<Address_of_Channe l ,0x0000); 

/* Clear flag to disable trapoziodal move */ 

Wri te_to_f lag_registor ( Address_of_Channe l ,0x0000 ); 

/* Set the controller motor control to bipolar operation */ 

Uri te_to_f lag_regi stor ( Address_of_Channe l , 0x0202); 

/* Clear flag to disable proportional velocity mode */ 

Wri te_to_f lag_registor (Address_of_Channel ,0x0303); 

/* Clear flag to disable intergal velocity mode */ 

Wri te_to_f lag_registor (Address_of_Channel , 0x0505); 

/* Initialize command position to 0 */ 

Wri te_command_pos(Address_of_Channel , zero) ; 

/*Initialize actual position to 0 */ 

Reset_Actual_Posi t ion( Address_of_Channel , zero); 

/* Initialize final pos i t i on to 0 */ 

Wri te_Final jx>s(Address_of_Channel , zero); 

/* Set up sample timer for the controller V 
Wri te_to_s ample retime r(Address_of _Channe l , Samp l e_T ime CCh_num] ); 

/* Initialize the filter parameters for the digital filter */ 
Write_Fi lterJ>ole(Address_of_Channel , Fi Iter Po l e [Ch_num] ) ; 

Wr i t ej i l ter_Zero( Address_of “channel , F i l ter“zero [Ch^num] ) ; 

Wri te_Fi l ter_Gain(Address_of_Channel , Fi lter_Gain[Ch_num] ); 

Accel_data [0] = Max_Accel CCh_num] ; 
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Accel_data[11 = Max_Accel [Ch_nun * 1]; 

/* Output the values of acceleration to the controllers */ 
Wri te_Max_Accet (Address_of_Channel , Accel_data); 

/★ output the velocity value to the controllers*/ 

Write Max_Veloci ty(Address_of_Channel ,Max_Veloci ty [Ch_num] ); 

/* Put the motor controller into the control mode */ 

Write to prog ram_counter(Address_of_Channe l ,0x0303); 

> /* End of for loop Ch_nun < 3 */ 

> /* End of function Call_Routine */ 


int Set_Motor_Posi tion( unsigned Address_of_Reset , int Reset) 
i 

long int Posit ion [2] = {0,0>; 

/* If reset pin is equal to 1 reset all position cointers to zero */ 
if (Reset == 1 ) 

Reset_Ac tua l_Pos i t i on( Address_of _Reset , Pos i t i on) ; 
else 

/* Read actual position of motors */ 

Read_Actua l_Pos(Address_of_Reset , Position); 

/* Put motor controller pair into idle mode */ 

Wri te_to__program_counter(Address_of_Reset, 0x0101); 

for (timelasped = 5000; timelasped > 0; timelasped = timelasped - 1); 

/* Initialize command position to actual position */ 

Wri t e_command_pos ( Addr ess_of _Reset , Pos i t i on) ; 

/* Initialize final position to actual position */ 

Wri te_F i na l _pos ( Address_of _Reset , Pos i t i on) ; 

/* Put motor controller pair back into control mode */ 

Wr i te_to_program_counter(Address_of_Reset ,0x0303); 

for (timelasped = 10000; timelasped > 0; timelasped = timelasped - 1); 

> 


/* Function Reached_Commanded_Pos checks to see if the motors have reached 
their commanded position */ . 

int Reached Commanded_Pos(unsigned Mot_Add,long int *Target_value, int Channel 

t 

int Target_Reached = 1; 

long int Pres_Pos[2]; 

long int Delta_pos1 ,Delta_pos0; 

int delay; 

int Check_count = 0; 


int Difference) 


while ( (Target_Reached == 1) && (Check^count < 6)) 
i 

Read_Act ua l_Pos( Mo t^Add , P r es_Pos ) ; 

/* Compute deltas between present and target position */ 
Delta _pos1 = labs(Target_value[1] - Pres_PosC1)); 

Delta_pos0 = labs(Target_value[0] • Pres_PosC0] ); 

if ((Delta _pos1 > Difference) || (Detta_pos0 > Difference)) 
C Target_Reached = 0; Check_count == 0; ) 
else 

i Target^Reached = 1; Check_count +*►; 
for (delay = 0; delay < 5000; delay**); 

> 

> 

return Target_Reached; 

) 
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/* Manual. C: Main executive for manual control of the dc servo motors ‘/ 


^include <stdio.h> 

#include <conio.h> 

# include <ctype.h> 

#include <time.h> 

#include <graph.h> 

#include <dos.h> 

#include <time.h> 

extern FILE *Manual_test_ptr; /* Set up pointer for file to output error data */ 

extern FILE *Align_Ptr; 

extern FILE *System_Ptr; 

extern FILE *AzEl_Ptr; 

extern FILE *Track_AzEl_Ptr; 


extern int C_Port_Data = 0; 
extern unsigned Port_C_Address; 
extern Set_to_actual; 


/* Declare the following variables external these var. are declared in motor. c / 
extern unsigned Motor_Pai r1_Address; /‘Address to first pair of motor controllers 

extern unsigned Motor J>ai r2_Address; /‘Address to first pair of motor contro ers 

extern unsigned Motor Pair3 Address; /‘Address to first pair of motor controllers 


V 

*/ 

*/ 


int Pwr 24Volts_On = 0x20; /‘Variable used to turn on 24 volt supply */ 

int Pwr~24Volts_0ff = OxDF; /‘Variable used to turn off 24 volt supply / 

long int Offset_Posi tion[3] [4] ; 
int mode = {0}; 

extern unsigned Control word_address; /‘ Address to which 8255 command word 

is being set */ 

extern unsigned Control_word; /* Sets all ports A,B to inputs & C to outputs */ 

extern struct Channel_data 

< 

unsigned Time_tag; 
double V_error; 
double U_error; 
double Signal_strength; 
signed char Transmi t_Data; 

> Channel [3] , Test [3] ; 


void main () 

< 

int Key_data= 0; 
int Primary_Menu = 0; 

/★ Assign channel asignments to data array ‘/ 

Test[0] .Transmit_Data=0; 

Test CD .Transmit_Data=1; 

Test [2] .Transmi t”Data=2; 

_setvideomode(_HERCMONO); /* Set mode of graphics to Hercules monitor */ 

/* Open all files as required mode = 0 Indicates manual mode */ 

Open_f i l es (mode) ; 

/* Output control word to 8255 ‘/ 

out p( Cont ro l_word_address , Cont ro l_word) ; 

/* Initialize motor controllers */ 

Initial ize_Controllers(); 

/* Turn on 24 Volt power supply */ 

C_Port_Data = C_Port_Data | Pwr_24Vol ts_0n; 
outp( Port_C_Address , C_Port_Data ) ; 

whi led) 

C 
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74 if (Pr imary_Menu == 1) 

75 Keyjdata = Display_Main_Menu( ); 

76 else 

77 Key_data = Display_Secondary MenuO; 

78 

79 Process_Hain Opt ion(Key_data); /^Process key that was pressed */ 

80 > 

81 

82 > 

83 

84 

85 vo i d C l os e_down( void) 

86 { int ch; 

87 

88 ComCloseAll ( ); /* Close all serial ports */ 

89 

90 /* Turn off 24 Volt power supply */ 

91 C_Port_Data = C_Port_Data & Pwr_24Vol ts_0ff ; 

92 outp(Port_C Address, C Port Data); 

93 ~ 

94 /* Set all position registors to actual position to stop motors V 

95 Set_Motor_Posi t ion<MotorJ>ai r1_Address, Set_to_actual ); 

96 Set_Motor_Pos i t i on(Hot or_Pa i r2~Address , Set_to”actua l ) ; 

97 Set Motor_Posi tion(Motor_Pai r3 Address, Set to actual); 

98 

99 Wr i te__systetn_data( ); /* Read position of motors and store data */ 

100 fclose (Manual_test_ptr); /* Close file when done V 

101 fclose (Align_Ptr); 

102 fclose (Systefn_Ptr); 

103 fclose (AzE l_Ptr) ; 

104 fclose (Track AzEl_Ptr); 

105 

106 exit (1); 

107 

108 ) 

109 

110 
111 
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#include <stdio.h> 

#include <conio.h> 

^include <ctype.h> 

^include <time.h> 

#include <graph.h> 

#incLude <dos.h> 

#include <time.h> 

#include <float.h> 

#include <stdlib.h> 

extern long int Starting_Position[2] [3] ; 
extern double Azimuth [3] , Elevation [3] ; 


/* Selected_Channel array is defined as follows first element indicates 
electronic & software channel and second element denotes optical channel */ 

int Selected_Channels [3] [2] = CO ,2), {2, 1},(3,3}>; 
int Channel_to_Run[4] = <0, 0,0,0}; 
int Number_of_Char>nel s_To_Run = 3; 

cbar key_buf fer [80] ; 
char buffer [80]; 

int exi t_loop, loop_test; 
int opt ionjcey, chan; 
unsigned statusword; 
double temp_az [3] ; 
double temp_el[3]; 

void Se l ect_Aze ^Changes (void) 

exit_loop = 0; 

Read_AzEl_data( ); 

/* store values read in program into temporary array */ 
for (chan = 0; chan <= 2; chan++) 

C 

temp_az[chan] = Azimuth [chan] ; 
tenp~el Cchan] = Elevat ion [chan]; 

"> 

whi le <exit_loop != 1) 
i 

_clearscreen( _GCLEARSCREEN ); 

_settextposition(1 ,1 ); /*Position the cursor at position 1,1)*/ 

printf ("\n ** Azimuth and Elevation options menu ** \n\n"); 

printf ("Channel 1 Azimuth = %8.6f,(Deg.) Channel 1 Elevation = %8.6f , (Deg. )\n 
, temp_az [1] , temp_el [1] ); 

printf ("Channel 2 Azimuth = %8.6f,(Deg.) Channel 2 Elevation = %8.6f , (Deg. )\n 
, temp az [0] , temp_el [0] ); 

printf ("Channel 3 Azimuth = %8.6f,(Deg.) Channel 3 Elevation = %8.6f , (Deg. )\n 
, temp_az[2] , temp_el [2] ); 

printf ( M \n1 . Change Azimuth and Elevation for Channel 1 \n M ); 

printf ("2. Change Azimuth and Elevation for Channel 2 \n M ); 

printf ("3. Change Azimuth and Elevation for Channel 3 \n"); 

printf ("4. Continue without saving changes \n M ); 
printf ("5. Save changes and continued"); 

printf ("\nSe l ect the one of the above options\n"); 
opt i on_key * -1; /* Reset value key value */ 

do 

C 

gets( key_buffer); 

opt ionjcey = atoi (keyjxjf fer); 

} while ( ( opt i on_key <= 0) || (option Jcey > 5)); 
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switch (option_key) 

< 

case 1 : 

< option_key =2; break;} 
case 2: 

option_key = 1; 

> 

/* Read in data from the keyboard that is an integer format */ 

if ( ( opt i on_key == 1) || (option key == 2) || (option_key == 3)) 

C ~ 

printf C*'\nEnter new value for azimuth in Degrees (Range +/*11)\n"); 
gets(key_buffer); 

temp_az Copt i on_key- 1 ] = atof (keyjxjf fer); 

printf ( M \nEnter new value for elevation in Degrees (Range +/-11)\n M ) 
gets(key_buf fer); 

temple l [opt ion_key-1] = atof (key_buf fer); 

> 

else if (option_key == 4) 

( 

exit loop =1; /* Set flag to exit main loop */ 

> 

else if (option_key == 5) 

< 

exit_loop = 1; 

/* Store changes back into array*/ 
for (chan = 0; chan <= 2; chan++) 

< 

Azimuth [chan] = temp_az [chan] ; 

E levat ion [chan] = temp el [chan}; 

> 

Wri te_AzEl_data( ); 

Write AzEl_Track Data(); 

> 


} /* End of while exit_loop != 1*/ 

} /* End of function Select_Azel_Changes */ 


/* Function Move_to_New_AZEL used to move to new azel location */ 
vo i d Move_t o_N ew_AZE L ( channe l , Mot or_Address ) 

< double Delta[4] , Alpha[4]; 

long int I_StepA[4], I_$tepB[4]; 

long int Command_Pos [2] ; 

int a,b, Number_of_Solut ions, loop, Solution; 

long int Present_Del ta = 10000000; 

double New_Azimuth = 12.0; 

double New_E levat ion > 12.0; 

_clearscreen( _GCLEARSCREEN ); 

_set tex tpos i t i on( 1,1); /*Position the cursor at position 1,1)*/ 

printf ("\n ** Azimuth and Elevation Channel Move ** \n\n n ); 

printf ("\nEnter new azimuth for move in Degrees \n M ); 
while ((New^Azimuth > 11.0) || (New Azimuth < -11.0)) 

gets(key_buffer); 

New_Azimuth = atof (key_buf fer); 

if ( (New_Azimuth > 11.0) || (New^Azimuth < -11.0)) 
printf ( M \nOut of range enter new value!! \n“); 

> 

printf ("\nEnter new elevation for move in Degrees\n M ); 
while ((New Elevation > 11.0) || (New_E levat ion < -11.0)) 

get s( key_buf f er ) ; 

New_E levat ion = atof (key_buf fer); 

if 7(New_E levat ion > 11.0) || (New_E levat ion < -11.0)) 
printf ( M \nOut of range enter new value! 7 \n"); 

> 
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NewJVzimuth = New_Azimuth/57.29577951; 

New~Elevation = New_Elevation/57.29577951; 

AzE l2AB(New_Azimuth, New_E Levat i on, I_StepA, I_StepB, Delta, 

Alpha, &Number_of_So l ut i ons ) ; 

printf ("\n Select one of the following alpha & delta pairs to move the channel to \n\n"); 

for (loop=0; loop <= Number_of_Solutions; loop++) 

^printf ("%i . ) Delta = %9.6f (Deg.) Alpha = %9„6f (Deg.)\n», 
loop+1 , Delta [loop] ,Alpha[loop] ); 

printf ("%i . ) Exit option without moving motors\n",Number_of_Solutions+2); 

do 

< 

gets(key_buffer); 

Solution = atoi(keyjxiffer); 

while ((Solution < 1) || (Solution > Number_of_Solutions+2)); 

if (Solution 1= (Number_of_Solutions+2)) 

/* Set up the commanded position for the DiskB Motor */ 

Command_Pos [0] = Start ing_Posit ion [0][channel-1] - I _St epB [Solution- 1) ; 

/* Set up the commanded position for the DiskA Motor V 

Command_Pos [1] = (-1 * Start ing_Positi on [1] [channel - 1] ) ♦ I_StepA [Solution- 1] ; 

/* Output new position to the motor controller */ 

Write_Final_pos(Motor_Address, Comma nd_Pos); 

/* Start trapozoidal move */ 

Wri te_to_f lag_registor ( Mo tor_Addr ess, 0x0808); 

> 

> 


void ScreenPrompt(void) 

( 

char Key_nunber; 
char tmpbuf [128]; 

_clearscreen( _GCLEARSCREEN ); 

_settextposition(10,1 ); /*Position the cursor at position 1,1)*/ 


printf(" Welcome to the Multiaccess terminal tracking program"); 

/* Display DOS-style date and time. */ 

_strtime( tmpbuf ); 

printf ( "\n\nTime:\ Xs\n", tmpbuf ); 

_strdate( tmpbuf ); 

printf ( "Data: %s\n", tmpbuf ); 


settextposi tion(20,1 ); /‘Position the cursor at position 1,1)*/ 
printf("Press 'e* to exit program at this time or return to continue"); 

while( IkbhitO); 

if (getchO == 'e') Close_down( ); 


void Select Channel s_to_Run( void) 

< 

char Key_number; 
char tmpbuf [128]; 
int Menu_opt i on = 0; 
int loop; 

int Channelise l ect = 0; 
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Read_AzEl_data(); 

while (Menu option != 4) 
i 

_clearscreen( _GCLEARSCREEN ); 

_settextposition(10,1); /^Position the cursor at position 1,1)*/ 

printf(" ** Channel selection menu **\n\n\n"); 
printf("The following channels have been selected: "); 

if (Selected_Channels[1] [1] != 0) 

printf ("%i »,Selected_Channels [1] [1]); 

if (Selected_Channels [0] [1] != 0) 

printf ("%i ",Selected_Channels [0] [1] ); 

if (Selected_Channels [2] [1] != 0) 

printf ("%i ", SelectedJThannels [23 [1]); 

printf ("\n\n"); 

printf ("1.) Add channel\n"); 
printf("2.) Remove channel \n"); 
printf ("3. ) Select all channels \n M ); 
printf ("4.) Continue and save selections \n M ); 

do 

{ 

gets( tmpbuf); 

Menu_option = atoi ( tmpbuf ); 

> 

while ((Menu_opt ion <= 0) || (Menu_option > 4)); 

if ((Menu_opt ion == 1) || (Menu_option == 2)) 

t 

printf ("\nEnter channel number [1 ,2,3] \n"); 

do 

< 

gets( tmpbuf); 

Channel_select = atoi (tmpbuf ); 

) 

while ((Channel_select != 1) && (Channel_select != 2) 

&& (Channelselect f= 3)); 

if (Menu_option »* 1) 

C 


if ( Channelise l ect == 1) Selected_Channels [13 [1 J = 1; 

else if (Channel_select == 2) $elected_Channels [03 (1) = 2; 
else if (Channel_select == 3) Selected_Channels [2] [1] = 3; 


> 

if (Menu_option == 2) 
t 


if (Channel_select == 1) Selected_Channels[1] [1] = 0; 

else if (Channeled ect == 2) Selected Channels [0] [1] = 0; 
else if (Channel_select == 3) Selected_Channels [2] [1] = 0; 


> /* End of if ((Menu_option == 1) || (Menu_option == 2)) */ 

if (Menu_option == 3) 

Selected_Channels [0] [13 = 2; 

Selected_Channels[1] [1] = 1; 

Selected_Channels[2] [1] = 3; 


> 


) /* End of while menu option != 4 */ 
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/* Confute the number of channels selected V 
Number_of_Channels_To_Run = 0; 
for (loop =0; loop <= 2; loop++) 

if (Selected_Channels [loop] til 1= 0) 

Number of_Channels_To_Run = Number_of_Channels_To_Run +1; 

ChanneI_toJ?un[Number~of_Channels_To_Run] = loop + 1; 

> 

> 

if ((Selected_Channels[03 [1] != 0) && (Selected_Channels[1] [1] ! 

< 

Channe l_to_Run[1 3 = 2; 

Channe l _to_Run [2] = 1; 

> 


Writ e_sy s t em_da ta(); 

Write_AzEl_data( ); 

Wri te_AzEl_Track_Data( ); 

Change_Input_Data( ); 

> /* End of function select channels */ 

void Check_System_Power(void) 

< 

int Power_on24,Power_on5; 

Power_on5 = Check_for_5Volts(); 

if (Power_on5 != 1) 

printf ("\n Turn +/-5 Volt power supply on"); 

Wai t_for_key_Press( ); 

> 

Power_on24 = Check_for_24Volts(); 
if (Power_on24 != 1) 

printf ("\n\n Turn +24 Volt power supply on"); 
Wait_for_key_Press(); 

> 

> 

void Check_Switch_Status() 

i nt Channel_Number , Pr i nt_output , Swi t ch_resul ts,Swi tch_act i vated; 
Print_output = 0; 

Swi tch_results = 0; 

Swi tch_acti vated = 0; 

for ( Channe l_Number = 1; Channe l _N umber <= 3; Channel_Number++) 

Swi tch_acti vated = Run_SwitchJJit(Channel_Number,Print_output) 
if (Switch_acti vated == 1) Swi tch_results = 1; 

> 

if (Switch_results == 1) 

Wa i t_f or ~key_Pr ess < ) ; 


void Check_Serial J. inks ( int Data_Port) 

C 

int Error, loop, I_channel ; 

* for (loop = 1; loop <= Number_of_Channels_To_Run; loop ++); 
l_channel = Channe l_to_Runt l oop] ; 

Error = Test_Serial _Link( I_channel ,Data_Port); 

if (Error == 0) printf ("\n\nSeri al link commini cat ions good\n"); 
ComC l oseA l l ( ) ; 
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/ jhe following include statements are required to allow 
program to link up with Turbo C++ libraries V 

^include <cport.h> 

#include <bios.h> 

#include <conio.h> 

#include <dos.h> 

#include <ctype.h> 

#include <stdio.h> 

#include <math.h> 

#def i ne BUC_SZ 9 

^define Nunber_of_samples 24 

FILE *outf i le [33 ; 

int Break_handler(void); 

/* Start main program here at this point / 


main(void) 

V Delcarations of these varibles will cause them to be stored in CPU 
Registers V 


int rv,out , status, Channel_niiit>er; 

int i, Channel=0; 

char output [803 ; 

signed char input Jxif fer [1024] ; 

unsigned int rs; . . 

int Elevation_error,Azimuth_error,Total_signal_strength, 

unsigned int Time_tag[33, Old_Time_tag[33 ; 

char *str = "Hello world"; 

int Frame_count [33 ,Process_data_f lag; 

int Relative flag*'N‘; 

char Mode_f lag, Fi le_f lag, log='N', a; 

int Good_data, Length_of_Message; 

int delay_time[103 = { 0 , 5 , 4 , 4, 3, 3,2, 2, 1,0}, 


double Elevation average, Azimuth_average,Signal_average, Signal_offset [3] ; 

double Azimuth deviat i on, E l evat i on_dev i at i on, Signa ^deviation, . cniiar .. 

double Aziniuth"deviation_square,Elevation_deviation_square,Signal_deviation_square. 

double Elevation, Azimuth, Signal_strength, last_signal[3], 

double Azimuth_total [3] ; 

double Azimuth~total_square[33 ; 

double E l evat i on_tota l [3] ; 

doub l e Elevation_total_square[33 ; 

double Signal_strength_total [33 ; 

HouhLe Si ana l strength total square [33 ; 


/* set variables equal to zero */ 


for ( i =0; i <3; i++) 
i Azimuth_total [ i 3 = 0.0; 

Azimuth_total_square[i3 = 0.0; 
Elevation_total [i3 = 0.0; 

E l evat i on~tota l_square [ i 3 = 0.0; 

Si gnal_strength — tota l [i 3 - 0.0; 
Signal_strength“total_square[i] = 0.0; 
T ime_tag[i3 =0; 

Old Time_tag[i3=0; 

} 

Frame_count [0] =0; 

F rame_count [13 =0 ; 

Frame count [2] =0; 


Process_data_f lag = 0; 

/* Set up handler for when Ctrl break key is pressed */ 
/* ctr l_brk(break_handler);*/ 


Initalize RS-232 port */ . 

rv = 2 bad 'com' parameter, rv = 3 no uart chip detected / w/ 

rv = 4 receive queue allocation error, rv = 4 transmit queue allocation error / 
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74 

/* the following line will be used for the compuadd computer at 115kbaud 


75 

rv = ComOpenCCOHl, B19200, W8|S1|NONE, 1024, 512); 


76 



77 

/* Set up C0M1 port to be active */ 


78 

ComActive(COM1 ); 


79 



80 

/* Remove all data from the receive buffer */ 


81 

ComFlushRxO; 


82 



83 

/* Remove all data from the transmit buffer */ 

- 

84 

ComFlushTxC ); 


00 

LTI 



86 

/* User interaction */ 


87 

printf("Do you what to run program in continous mode? Press 1 y 1 11 ) ; 

- 

88 

printf("for continous mode or any other key for manual mode"); 


89 

Mode_flag = toupper(getch( ) ); 


90 



91 

printf("\nDo you what to log the data to a file? Press , y ,n ); 


92 

File_flag = toupper(getch( )); 

*“ 

93 



94 

clrscr( ); 


95 

if (File_flag=='Y‘) 


96 

i outf ile[0] =fopen("ChannelO. raw", "w+"); 


97 

outf i le[1]=fopen("Channel1 .raw","w+"); 


98 

outf i l e [23 =fopen( "Channel 2. raw", M w+ M ); 


99 

fprintf (outf i le [0] , "Raw El.\tRaw Az.\tRaw SigAtAz\tEl\tSignal\n">; 


100 

fprintf (outf iletl], "Raw ElAtRaw Az.\tRaw Sig.\tAz\tEl\tSignal\n»); 


101 

fprintf (outf i l e [2] ,"Raw ElAtRaw AzAtRaw Sig AtAz\tEl\tSignal\n">; 


102 

l og= ' L 1 ; 


103 

> 


104 



105 

ComFlushRxO; 

_ -1 

106 



107 

whi le(1 ) 


108 

{ 


109 



110 

if (kbhitO) 


111 

{ a=getch(); 


112 

if (a == 'e' ) 


113 

i ComCloseAlK); 


114 

if (Fi le_f lag==* Y 1 ) 


115 

{ close?outf i le[03 ); 


116 

close(outf i le[1] ); 


117 

close(outf i le [2] ); 


118 

> 


119 

exit(0); 

— 

120 

> 


121 

to 

ii 

ii 

d 


122 

< Process_data_f lag =1; /* If «d* is hit process data */ 


123 

_i 

n 

o> 

o 


124 

> 


125 

if ((a= =, L ' ) | | (a==* l ')) 


126 

i l og= ' L ' ; > 


127 

if ((a=='S* ) || (a== 's' ) ) 


128 

i log='S'; > 

— 

129 

if ( (a== 'R 1 ) || (a== ( r')> 


130 

{ if (Relati ve_f lag== 1 Y ' ) 


131 

Relative_?lag='N •; 


132 

else 


133 

Relative flag^'Y 1 ; 


134 

> 


135 

if ((a== , Z l ) || (a== 1 z ' ) ) 


136 

< S i gna l_of f set [03 = l ast_s i gna l [0] ; 


137 

Signal_offset [T]=last_signal [1) ; 

— 

138 

Signal of f set [2] =last signal [23; 


139 

> 


140 

> 


141 



142 

if (Relative_f Lag!='Y' ) 


143 

{ Signal_offset [0]=0; 


144 

Signal_of fset [13=0; 


145 

Signal offset [23-0; 


146 

> 

- 

147 
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i f (Mode_f lag « ' Y 1 ) 
i Process_data_f lag = 1 ; > 
else 

{ if (kbhitO) 

< a= getchO; 
if (a == 'd' ) 

( Process_data_f lag = 1; 
log = 'L'; 

> 

if <<a== *L • ) || <a==* l 1 )) log = »L'; 

if ((a== 'S') || (a=='s')> 
log * 'S'; 

> 

> /* End of if mode_f lag - Y */ 

Gooddata = 0; 

whi le (Good data != 1 ) 

C 

/* Wait for data */ 
while (ComLenRxO == 0); 

Length_of_Message = ComLenRxO; 

/* Test to see if message is Longer than 9 words */ 
if ( Length_of_Message >9) 

Length_of ^Message = (Length_of_Message / 9) * 9; 

/* Delay program long enough to get rest of data */ 
de L ay ( de l ay_t i me [Leng t h_of _Message] ) ; 

if (ComLenRxO > BLK_SZ) ComFlushRxO; 

else 

rs = ComIn(input_buffer,BLK $Z); 

if ( ( i nput_buf f er [0] >= 0) J| (input_buffer[0] <= 2)) 
Good_data = 1; 
else ComFlushRxO; 

> 

> 


/* Check to see if flag is set to process data */ 
if (Process_data_f lag == 1 ) 

/* increment the counter for the number of frame samples 
that have been read in */ 

Channel=(int)(input_buffer [0] ) & 0x03; 

Frame_count [Channel]**; 

T ime_tag [Channel] = ( int)( input_buf fer [2] ) & OxFF; 

Time_tag [Channel] = Time tag [Channel] « 8; 

Time^tag [Channel] = Time”tag [Channel] | (( int)( input ^buffer [1] ) & OxFF); 

Elevation_error = (int)(input_buffer[4] ) & OxFF; 

Elevationerror = Elevationerror << 8; 

Elevation_error = Elevat ion_error | (( int)( inputjxif fer[3] ) & OxFF); 

Azimuth_error = (int)(input_buffer[6] ) & OxFF; 

Azimuth_error = Azimuth_error << 8; 

Azimuth%rror = Azimuth_error | ((int)(input_buffer [5] ) & OxFF); 

Azimuth_error = -Azimuth_error; 

Total_signal_strength = ( int)( input_buffer [8] ) & OxFF; 

Total_signal_strength = Total signa ^strength « 8; 

Totalis ignal_strength = Total_signal_strength | ((int)(input_buffer[7] ) & OxFF) 

/♦Change integer value to a floating point value for normalizing*/ 

Signa ^strength = Total_signal_strength; 

if (Signal_strength <= 1e-4) 
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< 

> 


Signal_strength = 0.0001; /* Set signal_strength to small 

number if equal 0.0 */ 


/* Normalize Azimuth compute total azimuth error for n samples 
as well as the sum of the squares */ 

Azimuth = Azimuth_error / S i gna l_st rength; 

Azimuth_tota l [Channel] ■*■= Azimuth; 

Azimuth_total_square [Channel] += Azimuth * Azimuth; 

/* Normalize Elevation compute total azimuth error for n samples 
as well as the sun of the squares */ 

Elevation = E levat ion_error / Si gna l_st rength; 

Elevat ion_tota l [Channel] += Elevation; 

E levat ion_total_square [Channel] += Elevation * Elevation; 

/* Scale signal strength to a DC value from a 12 bit D/A with 
a +- 10V input range */ 

Signal_strength = Signal_strength/204.7; 
last_signal [Channel] =Si gna l_st rength; 

S i gna l_st rength -=Signal_off set [Channel] ; 


if (Filejf lag=='Y' && (log=='L' || log=='l') && Mode_flag =='Y') 

{ fprintf (outf i l e [Channel] , H %i\t%i \t%i\t",E levat ion_error, 

Azimuth_error, 

Tota l_si gna l_st rength ); 

fprintf (outf i le[Channel] , "XSf \t%5f\t%5f\n H , Elevat ion. 

Azimuth, 

Signal strength); 

> 

/* Compute total signal strength for x samples as well as the sum 
of the squares */ 

Signal_strength_total [Channel] += Si gnal_strength; 

Signal_strength_total_square[Channel] += Signal_strength * Signal_strength; 

if (Frame_count [Channel] == Number_of_samples) 
t Azimuth_average = Azimuth_total [Channel] /Number_of_samples; 

Azimuth_deviat ion_square = (Azimuth_total_square [Channel] / 
Number_of_samples) - (Azimuth_average * 

Az i muth_average ) ; 

/* test to see if we have a negative number */ 

if (Azimuth_deviation_square < 0.0) Azimuth_deviation_square = 0.0; 

Azimuth_deviation = sqrt(Azimuth_deviation_square); 

Elevation_average = Elevation_total[Channel]/Number_of_samples; 
Elevation_deviation_square = (Elevation_total_square[Channel) / 
Number_of_samples) - (Elevat ion_average * 

E levat ion_a ve rage); 

/* test to see if we have a negative number */ 

if (Elevat ion_devi at ion_squa re < 0.0) E levat ion_deviation_square = 0.0; 

E levat ion_devi at ion = sqr t (Elevat ion_devi at ion_square); 

Signal_average = Si gnal_strength_total [Channel]/Number_of_samples; 
Signal_deviation_square = (Si gna l_strength_total_square [Channel] / 
Nimber_of_samples) - (Si gna leverage * 

S i gna leaver age); 

if (Signal_deviat ion_square < 0.0) Signal_deviation_square = 0.0 ; 

Signal_deviat ion = sqrt(Signal_deviat ion_square); 

if (Channel == 0) Channel_number = 1; 
else if (Channel == 1) Channel_number = 0; 
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else Channe l ^number * 2; 

gotoxyO , (5*Channel_number ) ♦ 1); 
clreolO; 

printf ("Channel X\ \n", Channel _nunber + 1); 
clreolO; 

printf ("Time = %6u v = %-1.5f u = X-1.5f Total = X2.3f ", 

T i me_t ag [Channe l ] , E l evat i on_average, Az i muth_average , 

Si gna leverage); 
if (Relative_f lagss'Y' ) 

< printf ("R"); > 

printf ("\n">; 
clreolO; 

printf ("S. Dev v = X-1.5f u = X-1.5f Total = %2.4f\n", 

E l evat i on_devi at i on, Az i muth_devi at ion, 

Signal_deviat ion); 

clreolO; 

gotoxyO, 22); 
clreolO; 

if <File_flag=='Y' && Clog=='L' || log=='l')) 

( printf ("Press 'S' to stop logging. "); > 
else 

< if (Fi le_f lag==‘Y 1 ) 

printf ("Press ■ L 1 to begin logging. "); 

> 

if (Relati ve_f lag=='Y 1 ) 

{ printf ("Press • Z • to zero signal strength "); > 
else 

{ printf("Press 1 R • to toggle reLative mode "); > 

if (Hode_f lag != 'Y') 

{ printf ("\nPress ■d* to sample data"); 

fprintf (out fi le [Channel) ,"Ti me = %6u v = X-1.5f u = %-1.5f Total = %2.3f\n", 
T i me_t ag [Channe l ] , E l evat i on_average , Az i muth_average , 

Signal average); 

> 

printf ("\n»); 

/* Reset variables used to total average amd sum of squares */ 

Azimuth_tota l [Channel] = 0.0; 

Azimuth~total_square [Channel] = 0.0; 

Elevation_total [Channel] = 0.0; 

El evat ion_tota l _square [Channel] = 0.0; 

Signal_strength_total [Channel] * 0.0; 

Signal_strength_total_square[Channel] = 0.0; 

/♦Reset frame counter*/ 

Frame_count [Channel] = 0; 

/* Reset process_data_f lag */ 

Process_data_f lag = 0; 

> /* End of if Frame_count = Number_of_samples */ 

) /* End of if process_flag = 1 */ 

> /* End of while (1)_!- */ 
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/* Display routine is used to provide the menu for manual control of the motors */ 

#include <stdlib.h> 

#include <stdio.h> 

#include <conio.h> 

#include <ctype.h> 

#include <time.h> 

#include <graph.h> 

#include <dos.h> 

#include <time.h> 

#include <math.h> 

#define BLK_SZ 8 
^define Pi 3.141592654 

/ Declare the following variables external these var. arp dprlarpH in nv>tnr r */ 
extern unsigned Motor_Pair1_Address; 
extern unsigned Motor_Pai r2_Address; 
extern unsigned Motor2Pair3_Address; 

extern unsigned Port_A_Address; 
extern unsigned Port_B_Address; 
extern unsigned Port_C_Address; 

extern long int Al ign_Position[2] [3] ; 

extern long int Start ing_Posit ion[2] [3] ; /♦ Array containing starting position */ 

extern long int Current_Posi t ion[2H3] ; 

extern double El_Az[2]; 
extern double Alpha_Del ta [2] ; 

extern struct Channel_data 

< 

unsigned Time_tag; 
double V_error; 
double U_error; 
double $ignal_strength; 
int Transmit Data; 

> Channel [33, Test [33; 

extern FILE *Manual_test _ptr; 
long int timelasped; 

/* The following variables are used for open loop testing */ 

double $tep_A =0.0; 

double $tep_B = 1.0; 

long int DiskAstep,DiskBstep; 

int Number_of_Frames = 1600; 

int Range = 400; 

long int Hotor_Pos [2] [3000] ; 

long int Actjx>sl2]; 

long int Zero_Position[2] = {0,0>; 

long int Step_Posi tion[2] = L0,0>; 

int delay; 

int Exi t_requested; 

int long Temp_actual ,Temp_new; 

extern int Reset_to_zero; /* These 2 variables wi l l be used global for setting motor position 
extern int Set_to_actual ; 

struct rccoord pos; 

int Sync_Pu l se_D i sab l e [3] = <0xBF,0x7F,0xEF>; 
int Sync_Pulse_Enable[3] = <0x40, 0x80, 0x1 0>; 

void Align_Channel (unsigned Address^of^Control , int Number^of channel, int Stop_Flag); 
void Compute_Open_Loop_Commands(unsi gned Channel_Address,Tnt”Number_of_Hotor, 
double Alpha_arm); 


/♦Address to first pair of motor controllers */ 

/♦Address to first pair of motor controllers */ 

/♦Address to first pair of motor controllers ♦/ 

/* Address of port A on 8255 */ 

/♦ Address of port B on 8255 */ 

/* Address of port C on 8255 */ 

/♦ Data containtining alignment positions * 


/♦ Align channel will be used to align the channels to a particular point ♦/ 

void Align_Channe l (unsigned Address_of_Control , int Number_of _channe l , int Store Flag) 


*/ 
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( 

int Long Step_size = 2000000; 
int Index_step_size = 1; 

int D i skB_Mo to renumber = 0; 
int D i skA_Motor_number = 0; 


int DiskA_Align_switch = 0; 
int DiskB~Align_switch = 0; 

int A l l_Swi tches_Good = 0x30; 
int Swi tch_activated; 
int Index_Mark_Found; 
long int delta = 250; 
long int alpha * -38; 


/* Bit pattern when no switches limits have been hit */ 
I* Flag used indicate switch activation */ 

/* Variable used to store index data */ 


int Delta limit = 3; /* Set limits for delta between actual and command position */ 

long int DiskB_delta_pos = 0; /* Variable for delta between command and 

actual position of the motor*/ 


long int DiskA delta_pos = 0; /* Variable for delta between command and 

actual position of the arm motor */ 


long int New_Posi tion[2] = 
Long int ActualJ>osi tion[2] 


(0,0); /* Mew position to which the motor must go to */ 

=(0,0); /* Actual Positon to which the motor must go to 


*/ 


long int DiskA_Pos_at_Alignment = 0; /* Position of Disk A when alignment was done */ 

long int Di skB_Pos_at_Al ignment = 0; 


int Aligned_Flag = 0; 
int Target_Reached; 

swi tch ( Number_of _channe l ) 

( 

case 1 : 

( 

Di skAAl ign_swi tch = 3; 

DiskB_Align_swi tch = 5; 

DiskBJtotorjiumber * 2; 

DiskA_Motor_number = 1; 
break; 

) 

case 2: 

( 

DiskA_Al ign_swi tch = 9; 

DiskB_Align_swi tch =11; 

DiskB_Motor_number = 4; 

Di skA_Motorju*nber = 3; 
break; 

) 

case 3: 

( 

DiskA_Al ign_swi tch = 15; 

D i skB_A l i gn_swi tch = 17; 

DiskB_Motor_number = 6; 

DiskA~Motor_number = 5; 
break; 

) /*End of switch case Channel_nint>er */ 

/* Read in actual position of motors at this time */ 

Read Actual Pos(Address_of_Control , Actual _Posit ion); 
Read~Actua l~Pos( Address_of _Cont ro l , Actua l_Pos i t i on) ; 

printf("\n Disk B motor position = %li "pActual _Position[0] ); 
printf <" Disk A motor position = XI i ",Actual J>osition[1] ); 

/* Set final position counters to actual position */ 

New_Position[0] = ActualJ>osition[03; 

New_Posi tiontl] = Actual _Posi tionEI] ; 

/* Beginning of loop to align system */ 
while (Aligned_F lag == 0) 



FILE: D:\TEMP\MOTCNT.C 

Size: 31775 Edited: 8-20-92, 9:52a 


Page: C49 


Printed: 11-17-92, 1:43p 


148 { 

149 /* Test for switch activation */ 

150 Switch_activated = Check_for_swi tch Activation(DiskA Align switch); 

151 “ 

152 printf ("\n Moving disks to activate switch Xi" ,0iskA Align switch); 

153 

154 /* Move Drum and Arm gears together till switch SW3 has been hit */ 

155 

156 while (Swi tch_activated != 1) 

157 < 

158 /*Set up positions for the move command */ 

159 /* Add delta to drum motor position */ 

160 New Posit ion [03 = New_Posit ion [03 + Step size; 

161 

162 /* Add delta to arm motor position */ 

163 New PositionCl) = New_Position[1j - Step_size; 

164 

165 /* Output new position to the motor controller */ 

166 Write Final_pos( Address of Control ,New_Posi t ion); 

167 

168 /* Start trapozoidal move */ 

169 Write to f lag_registor (Address of_Control ,0x0808); 

170 

171 /* Delay reading of motor till it as a chance to move */ 

172 for (timelasped = 5000; timelasped > 0; timelasped = timelasped - 1); 

1 73 

174 /* Check to see if the we have made it to new position or switch 

175 has been pressed */ 

176 do 

177 C 

178 Switch activated = Check_for swi tch_Act i vationCDiskA Align switch); 

179 > ~ " 

180 while (Switch_acti vated != 1); 

181 

182 for (timelasped = 60000; timelasped > 0; timelasped = timelasped - 1); 

183 

184 Read Actual_Pos(Address of Control ,Actual_Posit ion); 

185 

186 printf ("\n Disk B motor position = Xli ",Actual_Position[03 ); 

187 printf ( M Disk A motor position = Xli ", Actual Position[1)); 

188 

189 > /* End of while (Switch data != Sw3 detect)) V 

190 

191 printf (" \nSwitch Xi limit hit M ,Di skA Align switch); 

192 

193 for (timelasped = 200000; timelasped > 0; timelasped = timelasped - 1); 

194 

195 /* Set all position registors to actual position V 

196 Set_Motor_Position( Address of Control, Set to_actual); 

197 

198 /*** Start reversal of Disk A and Disk B gears till index mark on ***/ 

199 /*** Disk A motor is found ***/ 

200 

201 /* Read position of arm and drum motor */ 

202 Read Actual_Pos(Address_of Control ,Actual_Posi t ion); 

203 

204 printf("\nReverse direction of gear rotation till Disk A index mark is found\n H ); 

205 

206 printf ("\nDiskB Actual DiskB Command DiskA Actual DiskA Command Index"); 

207 printf ("\n Position Position Position Position Switch\n"); 

208 

209 /* Check for index mark */ 

210 /* I ndex_Mark_Found = Check for_Index Mark(DiskA Motor number); */ 

211 ~ 

212 Switch activated = Check_for_swi tch Acti vation(DiskA Align switch); 

213 ’ 

214 /* Set delta limit for delta between actual and command position*/ 

215 Del ta_l imi t = 30; 

216 

217 New_Posi t ion [0] = Actual_Position[03 ; 

218 New_Position[l3 = Actual PositionCl); 

219 

220 while (Swi tch_acti vated == 1) 

221 < 
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/* Add delta to arm motor position */ 

New_Posi t ion [13 = New_Posi t ion [13 ♦ Index_step_size; 

/* Output new position to the motor controller */ 

Write command_pos(Address_of_Control ,New_Position); 

/* Decrease window between actual and command position once switch 
is activated */ 

if ( (Swi tch_act ivated == 0) && (Deltajimit > 15)) 

Del ta_l imi t = Delta_limit - 1; 

/* Check to see if the we have made it to new position or switch 
has been pressed */ 
do 

C 


/* Read in data to look for index mark and switch activation*/ 

/* Index_Mark Found = Check_for_Index_Mark(DiskA_Motor_number); */ 

Swi tch_act ivated = Check_for_switch_Activation(DiskA_Align_switch); 

/* Check to see if commnaded position has been met */ 

Target Reached = Reached_Commanded_Pos(Address_of_Control ,New_Posi ti 
Nunber~of_channeI,Delta_l imi t); 

if ((Target Reached == 0) && (Swi tch_act ivated == D) 

Read_Actual_Pos(Address_of_Control ,Actual_Posi tion); 

New_Position(1] = ActuaT_Posi tiontl] ; 

Writ e_command_pos ( Addr ess_of _Cont ro l , New_Pos i t i on ) ; 

> 

Read JlctualJ>os(Address_of_Control, Actual _Posit ion); 

printf (•' XI Old X12ld X12ld X12ld X2d %2d\r», 

Actua Imposition CO] ,New_Position[0] , 

Actual_Position[1] ,New_PositionCl] , 

I ndeXmMark_Found, Swi tch^act ivated); 


> 

while ((Targetjteached == 0 ) && (Swi tch_act ivated == 1)); 

> /* End of while Index_Mark_Found and 

&& (Swi tch_act ivated == 1) *7 

printf("\n Disk ‘A' gear is aligned !!'*); 

Read^Actua l^PosC Address^of _Cont ro l , Actua l_Pos i t i on) ; 

/* Store position of disk A */ 

DiskA_Pos_at_Al ignment = Actua l_Posit ion Cl 1 ; 

/*** Hold Disk A gear steady and move Disk B gear till ****/ 

/*** switch Sw5 is activated **★*/ 

printf( M \n Moving Disk B to activate switch %i M ,DiskB_Al ign_swi tch); 

/* Read Disk A and Disk B motors current position */ 

Read_Actual_Pos(Address_of_Control ,Actual_Position); 

Mew_PositionC0] = Actual_PositionC0]; 

New_Posi tionCD = D iskA_Pos_at_A l ignment ; 

/* Check for switch 5 activation */ 

Swi tch_ac t i vated = Check^f orsw i tch_Act i vat i on(D i skB_A l i gnswi tch ) ; 
while (Swi tch_act ivated != 1) 

i 

/* Set up positions for the move command */ 

/* Add delta to Disk B motor position */ 

NewJ>ositionC0] = NewJ>osition[03 ♦ Step_size; 

/* Add delta to Disk A motor position */ 
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296 New_Posi t ion[1] = DiskA_Pos at_Al i gnment; 

297 

298 /* Output new position to the motor controller */ 

299 Wri te_Final_pos(Address_of Control, New Position); 

300 

301 /* Start trapozoidal move */ 

302 Write to f lag_registor (Address_of_Control ,0x0808); 

303 

304 /* Check to see if the we have made it to new position or switch 

305 has been pressed */ 

306 do 

307 i 

308 Switch_acti vated = Check for switch Acti vat ion(D i skB_Al ign switch); 

309 > 

310 while (Swi tch_acti vated != 1); 

311 

312 Read_Actual Pos(Address of Control , Actual Position); 

313 

314 printf( M \n Disk B motor position = %li ",Actual_Position[0] ); 

315 printfC Disk A motor position = %li ", Actual Positionll] ); 

316 

317 > /* End of while Switch activated != 1 */ 

318 

319 printfC \nSwitch %i limit hit M ,DiskB Align switch); 

320 

321 for (timelasped = 200000; timelasped > 0; timelasped = timelasped - 1); 

322 

323 $et_Motor Posi tion( Address of_Control ,Set to_actual); 

324 

325 /*** Reverse direction of Disk B gears till index mark on Disk B motor ***/ 

326 /*** is found Disk A gear wi l l be held steady ***/ 

327 

328 printf("\nReverse direction of gear rotation till Disk B index mark is found\n"); 

329 

330 /* Read position of arm and drum motor */ 

331 

332 Read_Actual Pos(Address_of_Control , Actual Position); 

333 

334 New_Posi t ion 10] = ActualJ>osi t ion[0] ; 

335 New Posit ion [1] = DiskA_Pos at Alignment; 

336 

337 /* Test for index mark and switch activation */ 

338 /* Index_Mark_Found = Check_for_Index_Mark(DiskB_Motor_number); */ 

339 Switch activated = Check for_switch Act ivation(DiskB_Al ign_swi tch); 

340 

341 /* Set delta limit for delta between actual and command position*/ 

342 Delta_limit = 30; 

343 

344 printf ("\nDiskB Actual DiskB Command DiskA Actual DiskA Command Index/"); 

345 printf("\n Position Position Position Position Switch\n"); 

346 

347 while (Swi tch_acti vated == 1) 

348 { 

349 /* Add delta to drum motor position */ 

350 New_Posi t ionCO] = New_Posi t ion[0] - Index_step_si ze; 

351 

352 /* Add delta to arm motor position */ 

353 New_Posi tionCl] = DiskA_Pos at Alignment; 

354 

355 /* Output new position to the motor controller */ 

356 Wri te_command_pos( Address of_Control ,New_Posit ion); 

357 

358 /* Decrease window between actual and command position once switch 

359 is activated */ 

360 if < (Swi tch_acti vated == 0) && (Delta_limit > 15)) 

361 Delta_limit = Delta limit - 1; 

362 

363 /* Check to see if the we have made it to new position or switch 

364 has been pressed */ 

365 do 

366 C 

367 

368 /* Read in data to look for index mark */ 

369 /* Index_Mark_Found = Check_for_Index_Mark(DiskB_Motor_number); */ 




FILE: D:\TEMP\MOTCNT.C Pa 9 e: C52 

Size: 31775 Edited: 8-20-92, 9:52a Printed: 11-17-92, 1:43p 


370 

371 

372 

373 

374 

375 

376 

377 

378 

379 

380 

381 

382 

383 

384 

385 

386 

387 

388 

389 

390 

391 

392 

393 

394 

395 

396 

397 

398 

399 

400 

401 

402 

403 

404 

405 

406 

407 

408 

409 

410 

411 

412 

413 

414 

415 

416 

417 

418 

419 

420 

421 

422 

423 

424 

425 

426 

427 

428 

429 

430 

431 

432 

433 

434 

435 

436 

437 

438 

439 

440 

441 

442 

443 


Swi tch_act i vated = Check_f or_swi tch_Act i vat i on(D i skB_Al i gn_sw i tch ) ; 

/* Check to see if commnaded position has been met V 

Target_Reached = Reached_Commanded_Pos(Address_of_Control f New_Posi t i on, 
Number_of_channel ,Del ta_l i mi t ); 


/* Resend position command if delta becomes to large and 
switch is not activated V 

if ( (Target_Reached == 0) && (Swi tchjscti vated == 1)) 
i 

Read_Ac t ua l _Pos ( Add r ess_of _Cont ro l , Ac t ua l _Pos i t i on ) ; 
New_Position[0] = ActuaT_Position[0] ; 

Wr i t e_command_pos ( Addr ess_of _Cont ro l , New_Pos i t i on) ; 


> 

Read_Actual_Pos(Address_of_Control,Actual_Posi tion); 

printf (*' %10ld %12ld %12ld %12ld X2d X2d \r», 

Actual_Posi tionCO] ,New_Position[0] , 

Actual_Posi t ion [13 ,New_Posi tiontl] , 

IndexMark Found, Swi tch_acti vated); 


> 

while ((Target_Reached == 0) && (Sw it deactivated == 1)); 


> /* End of while Index_Mark_Found ! = 0 */ 
printf ( ‘“\n Disk ■ B ' gear is aligned M \n"); 

/* set up for command to go to alingment for both motors to index mark */ 

New_Posi tion[0] = Actual_Posi tion[0] ; 

DiskB_Pos_at_Al ignment = Actual_Position[0] ; 

New_Posi t ionTll = DiskA_Pos_at_Al ignment; 

Wri te_command_pos(Address_of_Control ,New_Posi t ion); 

Aligned_Flag = 1; 

> /* End of while aligned = 0 */ 


Delta_limit = 15; 

/********** m ovc arm back to home position ******************/ 


/* Reset all position registors to zero V 

Set_Motor_Posi t i on(Address_of_Control ,Reset_to_zero); 

New_Posi tion [0] = -25000; 

New_Posi tion[1] = 0; 

/* Initate movement of motor to swing over arm */ 

Wr i te_Final_pos(Address_of_Control, New J>osi tion); 

Wri te_to_f lag_registor (Address_of_Cont rot ,0x0808); 


Target_Reached = 0; 


while (Target_Reached != 1) 

< 

/* check to see if commnaded position has been met V 
Target_Reached = Reached_Commanded_Pos(Address_of_Control ,New_Posi tion, 
Number_of_channel ,Delta_l imi t); 


> 


/♦Store data as required and move to home position */ 
if (Store_Flag == 1) 

New_Position[0] = -DiskB_Pos_at_Alignment; 
New_Position[1] = -Di skA_Pos_at_Al ignment; 

/* Read in data with present values for alignment V 
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ReadJU ign_data( ); 

Alignj>osition[0] [Number_of_channel - 1] = Di skBJ>os_at_Al igrment ; 
A l ign_Posi tion [1] [Number_of_channel -1] = DiskA~Pos_at_Aligrment; 

/* Write out new data for alignment */ 

Wri te_Al ign_data(); /* Write out new alignment data */ 

> 

else 

{ 

Read_Al ign_data( ); /* Read in data for alignment purposes */ 

/* Compute position for Disk B motor for arm only move V 
New_Posi t ion[0] = -Align_Posi tion [0] [Number of_channel-1); 
New_Posi tionfl] = -Al ignJ>osition[1) [Number“of channel-13; 


/* Initate movement of motor */ 

Wr i te_F inal_pos(Address_of_Control , New_Posi t ion); 

Wri te_to_f lag_registor (Address_of_Control ,0x0808); 

Target_Reached = 0; 

while (Target_Reached != 1) 

/* Check to see if commnaded position has been met */ 

Target_Reached = Reached_Commanded_Pos(Address_of_Control,New_Position, 
Number_of_channel ,Delta_l imit); 
printf("\rWai ting for channel to reach home position 11 ); 

for (timelasped = 10000; timelasped > 0; timelasped = timelasped - 1); 


/* Wait for motors to stop running */ 

for (timelasped = 60000; timelasped > 0; timelasped = timelasped - 1); 

/* Reset motor to 0,0 position */ 
Set_Motor_Position(Address_of_ControL, Reset to zero); 

/* Store new starting position after alignment V 
Starting_Position[0] [Number_of_channel-1] = 0; 

Start ing_Posi tion [1] [Number_of_channel -1} = 0; 

> /* End of alignment function */ 


/* Function will be used to rotate platter through is paces V 
int Exercise_Channe l (unsigned Control_Address, int chan number) 

int long alphajnove = -40; 

int long deltajnove = 100; 

int long New_Pos[2] = C0,0>; 

int long Send_Pos[2] = {0,0}; 

int long Actual_Pos [2] = {0,0}; 
int swi tch_number = 3; 
int count; 

int Activated_switch; 

Exi t_requested = 0; 

while (Exit_requested == 0) 

{ 

for (count = 1; count <= 4 ; count = count ♦ 1) 

{ 

switch (count) 

{ 

case 1: 

{ 

if (chan_number == 1) switch_number = 3; 

else if (chan_number == 2) swi tch_number = 9; 
else if (chan_number == 3) swi tch_number = 15; 
alpha_move = 0; 
delta_move = +500; 
break; 
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> 

case 2: 

< if (chan_number == 1) swi tch_number = 4; 

else if (chanjumber == 2) swi tch_number = 10; 

else if (chan_number == 3) swi tchjiumber = 16; 

alphajnove = 0; 
deltajnove = -500; 
break; 

> 

case 3: 

Sf (chan number == 1) swi tchjiumber = 5; 

else if <chan_number == 2) swi tchjiumber = 11; 

else if (chanjumber == 3) swi tchjiumber = 17; 

alphajnove = +100; 
deltajnove = 40; 
break; 

> 

case 4: 

if (chan number == 1) swi tch_r>umber = 6; 

else if (chanjumber == 2) swi tchjiumber = 12; 

else if (chanjumber == 3) swi tchjiumber = 18; 

alpha_move = -100; 
deltajnove = 0; 
break; 

> 

> /* End of switch count case*/ 

Set_Motor_Posi t i on(Control_Address,$et_to_actual ); 

/* Delay reading of motor till it as a chance to move */ 

for (t imelasped = 50000; timelasped > 0; timelasped = timelasped - 1); 

Read_Actual_Pos ( Cont ro l_Address f Ac t ua L_Pos ) ; 

/*Set up positions for the move command */ 

/* Add delta to Disk B and Disk A motor position */ 

New_Pos [0] = (alphajnove * 769) + (1967 * deltajnove) ♦ Actual _Pos [0] ; 
New_Pos [1] = ActuaTPosCl] ■ (1967 * delta^move); 

/* Output new position to the motor controller */ 

Wr i te_F i na l_pos ( Cont r o l_Addr ess , New _Pos ) ; 

/* Start trapozoidal move */ 

Write to_f lag_registor ( Cont ro l ^Address, 0x0808); 

/* Check to see if the we have made it to new position or switch 
has been pressed */ 
do 

( 

if (kbhitO) 

C 

Exi t_requested = 1; 
break; 

Activated_swi tch = Check_for_switch_Activation(swi tch_nunber); 

> 

while (Activated_swi tch i= 1); 

/* Exit for loop if key has been pressed */ 
if (Exit_requested == 1) break; 

/* Delay reading of motor till it as a chance to move */ 

for (timelasped = 50000; timelasped > 0; timelasped = timelasped - 1); 

if (count == 4) /* Move arm to center position */ 

Set_Mot or _Pos i t i on( Cont ro l^Address , Set_to_actual ) ; 

/* Delay reading of motor till it as a chance to move */ 

for (timelasped = 50000; timelasped > 0; timelasped = timelasped - 1) 
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Read_Actual _Pos( Control Jlddress, Actual J>os); 

deltajnove = 0; 
alphajnove = 40; 

/*Set up positions for the move command */ 

/* Add delta to Disk B and Disk A motor position */ 

New_Pos[0] = (alphajnove * 769) + (1967 * deltajnove) + Actual Pos[0]* 
NewJ>os[1] = Actual J>os[1] - (1967 * deltajnove); 

Send_Pos [0] = New_Pos (0] ; 

Send_Pos [1) = NewJ>os[1]; 

/* Output new position to the motor controller and start move*/ 

Wri te_F inal jx>s( Control _Address, Send Pos); 

Wri te_to_f lag_registor ( Contro l ^Address, 0x0808); 

/* Wait till arm makes its way back to home position */ 
while ( labs(Actual_Pos [0] - New_Pos[03) > 25) 
t 

/* Delay to give motor a chance to respond to trapizodal move */ 
for ( t imelasped = 5000; timelasped > 0; timelasped = timelasped - 1)* 
Read_Ac tual_P°s( Contro l_Address, Ac tual_Pos); 


> 

> /* End of for loop */ 

> /* End of whi le 1*/ 

/* Stop motors and reset all positions counters to actual position */ 
Set_Mot or_Pos i t i on( Cont ro l_Address , Set_to_actua l ) ; 

>/* End of function */ 


void Run_BackJ.ash_Test( unsigned Address_Motor, int Port_C_Data, int Nun*> Chan 
int Number j)f_Mo tor ) 


i 

int Fr ame^Count = 0; 

double Alpha; 

/* Print out title indicating test to be run */ 
if ( Number j^fjiot or == 1) 

fprintf(Manual_testjDtr,"\nBacklash test for Disk B (U error"); 
else if (Number_of_Motor == 2) 
fprintf (Manual_test_ptr,"\nBacklash test for Disk A "); 
else if (Number_of Jlotor == 3) 

fprintf (Manual _test_ptr , "VnBacklash test for Disk A & B moving together (V error)") 
else if ( Number j)f Jlotor == 4) 

fprintf(ManuaT_test_ptr,"\nBacklash test for Disk A & B moving a part"); 


/* Print header file for data */ 

fprintf (Manual Jest j3tr,"\nT imeTag \tSig Lev\tU Error\tV Error"); 
fprintf (Manual Jest _ptr,"\tActB\tDiskBC\t ActA\tDiskAC")7 

Set_MotorJ>osition(Address_Motor,Set_to_actual); 

/* Read data from system file on present position */ 
Read_Current_System_data( ); 

DiskAstep = CurrentJ>osi t ionfl] [Numb_Chan - 1]; 

DiskBstep = Current_Position[0] [Numb^Chan - 1] ; 

Compute_AZ_EL (DiskAstep, DiskBstep, 0,El Jz, Alpha_Del ta); 

Alpha = A l phajelt a [03/57. 29577951; 

Comput e_Open_Loop_Commands ( Address_Hot or , Number j)f Jlotor , A l pha ) ; 


/* Compute commands for open loo 
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Port_C_Dat a = Port_C_Data | SyncJ>ulse_Enable[Numbj:han - 1]; 
out p( Por t_C_Address , Por t_C_D at a ) ; 

ComFlushRxO; 

while ( Frame_Count <= Number_of_Frames) 


i while (ComLenRxO < BLK_SZ); /* Wait for data to come over */ 

Read_Actual_Pos(Address_Motor , Act _pos ) ; 

Step Posit ion [0] = Motor_Pos[0] [Frame_Count + 13; 
Step’PositionCl] = Motor~Pos [13 [Frame_Count ♦ 13; 

Write Final _pos(Address_Motor,Step_Posi tion); 

Wr i te_to_f lag_regi stor (Address_Motor,0x0808); 

Read_Channel_Data(&Test [Numb_Chan - 13); 


if (Act_jx>s[03 >= 0x7fffff) 
Act_pos [03 -= Oxffffff; 


if (Act_pos [1] >= 0x7f f f f f ) 
Actjoos [13 -= Oxffffff; 


fprintf (Hanua latest jDtr," \n%u, X2.3f, \t %1.5f, 

Test [Numb_Chan - 1] .Time_tag,Test [Nur*>_Chan 
Test [Numb_Chan - 13 .U_error Jest [Numb_Chan 
Act__pos [03 ,Motor_Pos [03 [Frame_Count3 , 

Act jx>s [13 ,Motor_Pos [13 [Frame_Count3 ); 


\t%1.5f, \t%l i ,\t %li,\t %l i ,\t%l i", 
- 13 ,$ignal_strength/204.7, 

- 13.V_error, 


Frame_Count++; 

> /* End of while loop V 

Port_C_Data = Port_C_Data & SyncJ>ulseJ)isable[Numb_Chan - 13; 
out p( Port_C_Address , Por t_C_Data ) ; 

> /* End of function Run_Back_Lash_Test V 


void Run_Step_Test( unsigned Add_of_Motor, int C_nimber, int Step_value, int Option) 

int long Act_stepjx>s_array_B [10003 ; 
int long Act _step_pos_array_A [10003 ; 
int Sample_total = 1000; 
int Number_of_samples = 0; 
int Array_count = 0; 
unsigned AD_data [10003 ; 
int AD_dataA,AD_dataB; 
unsigned UAD_dataA,UAD_dataB; 


Read_Ac t ua l _Pos ( Add_of _Mot or , S t ep_Pos i t i on ) ; 


if ((Option == 1) || (Option == 5)) 

Step_Position[03 = Step_value + Step_Position[03 ; 
Step_Posi tion[l3 = 0 + Step_Posi tion[1] ; 

else if ((Option == 2) || (Option == 6)) 

Step_Position[1] = Step_value + Step_Position[l3 ; 
Step_Posi tion[03 * 0 + Step_Position[03 ; 

else if ((Option == 3) || (Option == 7)) 

i Step Posit ion [13 = - Step_value + Step_Position[13; 
StepJ>osition[03 = Step_value + Step_Posi tion[03 ; 

> else if ((Option == 4) || (Option == 8)) 

Step_Position[1] = Step_value + Step_Posi t ion(13 ; 


/* Assign step value for disk b motor */ 


/* Assign step value for disk b motor */ 


/* Assign step value for disk b motor */ 
/* to run in same direction */ 


/* Assign step value for disk b motor */ 


FILE: D:\TEMP\MOTCNT.C 

Size: 31775 Edited: 8-20-92, 9:52a 


Page: C57 


Printed: 11-17-92, 1:43p 


740 

741 

742 

743 

744 

745 

746 

747 

748 

749 

750 

751 

752 

753 

754 

755 

756 

757 

758 

759 

760 

761 

762 

763 

764 

765 

766 

767 

768 

769 

770 

771 

772 

773 

774 

775 

776 

777 

778 

779 

780 

781 

782 

783 

784 

785 

786 

787 

788 

789 

790 

791 

792 

793 

794 

795 

796 

797 

798 

799 

800 
801 
802 

803 

804 

805 

806 

807 

808 

809 

810 
811 
812 
813 


Step Position[0] = Step value + Step_Posi tionCO] ; 

) 


if ((Option >=1) && (Option <= 4)) 

W r i te_command_pos( Add_of _Motor , Step_Pos i t i on) ; 
else 

{ 

Wri te_Final_pos(Add_of_Motor,Step_Posi t ion); 

Write to flag registor (Add_of Motor, 0x0808); 

> 

while (Number_of_samples < Sample total) 

C 

AD_data [Number_of_samples] = ReadJJbitjx>rt(Add_of_Motor); 
Read_Actua l_Pos( Add_of_Motor , Act_pos ) ; 

Act_step_pos_array_B [Number_of_samples] = Act_pos[0]; 
Act_step_pos_array_A [Nunber_of_samples] = Act jxjs[1]; 
Number_of_samples++; 


fprintf (Manual_test_ptr,"\nNumber of samples taken = Xi", Number of_samples); 
/* Store sampled data */ 

for (Array_count = 0; Array_count < Number_of_ samples; Array_count++) 

UADjdataB = AD data [Array count] & OxFF; 

AD_dataB = (UAD_dataB) - 128; 

UAD_dataA = AD_data [Array_count] & OxFFOO; 

UAD_dataA = UAD_dataA >> 8; 

AD_dataA = UAD_dataA - 128; 

fprintf (Manua l_test_pt r , "\n%d" , Act_step pos array_B [Array count]); 
fprintf (Manual _test _ptr," %d ",AD_dataB);~ 

fprintf (Manual_test_ptr," %d", Act_step_pos_array ACArray count]); 
fprintf (Manual_test jDtr," Xd ",AD_dataA); 

> 

> 

void Run_Eccen_Jest( unsigned Motor_Address, int CPort,int Number_of_Channel ) 
i 

int DA_data,AD_dataB,AD_dataA; 
unsigned UAD_dataB,UAD_dataA; 
long int Present_Posi tion[2] ; 
long int Command_Pos [2] ; 
int Lef t_L imi t [3] = <4,10,16); 
int Right_Limit[3] = {3,9, 15>; 
int Limit_Hit = 0; 

fprintf (Manual_test_ptr, "DiskBApos D/A DiskAApos D/A"); 

/* Set up position to move to designated limit */ 

Command_Pos [0] = 1000000; 

Command_Pos[1) = -1000000; 

Read_Actua l_Pos(Mot or_Address , Presen t_Posi t ion); 

Command_Pos [0] = Present_Posi tion[0] + Command_Pos [0] ; 

Command_Pos [1] = Present_Posi t ion[1] + Command_Pos [1] ; 

/* Output new position to the motor controller and start move*/ 

Wr i te_Final _pos ( Mo tor_Address , Command_Pos ) ; 

Wri te_to_f lag_registor (Motor_Address, 0x0808); 

/* Wait till first limit has been reached */ 
whi le (Limi t Hit == 0) 

< 

Limi t_H i t = Check_for_switch_Activation(Right_Limit [Number_of_Channel - 1]); 


Set _Motor_Pos i t i on(Motor_Address , Set_to_actua l ); 

/* Set up position to move to designated limit */ 
Command_Pos [0] = -1000000; 
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Ccxmvand_Pos [1 ] = +1000000; 

Read Actual Pos(Motor_Address,Present_Posi t ion); 

Conrnand_Pos"[0] = Present_Posi tiontO] + Command J>os £0] ; 
Command~Pos [1 ] = Present_Posi tion[1] + Command_Pos [13 ; 

/* Output new position to the motor controller and start move*/ 
Wr i t e_F i na l _pos < Mot or_Address , Command_Pos ) ; 

Wri te_to_f lag_registor (Mot or Address, 0x0808); 

/* Enable receiver electronics for timing purposes */ 

CPort = CPort | Sync_Pulse_Enable[Number_of_Channel - 13; 
outp(Port_C_Address,CPort); 

ComFlushRxO; 

Limit_Hit = 0; 

whi le (Limi t_Hit == 0) 


while (ComLenRxO < BLK_SZ); /* Wait for data to come over */ 
ComFlushRxO; /* Flush out receive buffer to avoid overflow */ 
DA_data = Read_8bi t_port(Motor_Address); 

Read_Actual_Pos(Motor_Address,Present_Posi tion); 

if ( Present_Pos i t i on C 1 ] > 0x7fffff) 

PresentJ>osition[1] -= Oxffffff; 

if ( P resent_Pos i t i on [0] > 0x7fffff) 

Present_Position[0] -* Oxffffff; 


UAD_dataB = DA_data & OxOOFF; 
AD_dataB = UAD_dataB - 128; 
UAD_dataA = DA_data & OxFFOO; 
UAD_dataA = UAD_dataA » 8; 
AD_dataA = UAD_dataA - 128; 


/* Output data to file for reveive */ 
f pr i nt f ( Manua l _t es t jpt r , "\n%1 Old", Present_Pos i t i on [03 ) ; 
f pr i nt f ( Manua l_test_pt r , " X5d " , A0_dat aB ) ; 

fprintf (Manua l_test_ptr," %10ld",Present_Position£l3 ); 
fprintf (Manua l_test_ptr," %5d ",AD_dataA); 

Limit Hit = Check_for_switchJlctivation(LeftJJrnit CNumber_of_Channel - 1] 


/* Disable sync pulse to receiver electronics */ 

CPort = CPort & Sync_Pulse_Disable[Number_of_Channel - 13; 
outp( Port_C_Address , CPort ) ; 


> /* Function Compute_Open_Loop Command */ 


void 

C 


Compute_Open_Loop_Commands( unsigned Channel_Address, int Motor_Nui*>er , 
double Alpha_arm) 


int Frame_count = 0; 
double Int_Motor_PosA = 0; 
double Int_Motor_PosB = 0; 


if (Motor_Number == 1) /* Move only disk b motor */ 

Step_A = 0; 

Step_B = 1.0; 

else if (Motor_Number == 2) /* Move only disk a motor: */ 

< 

Step_A = -1.0; 

Step B = 0; 

> 


else if (Motor_Number == 3) /* Move only disk A & B motor: 

disk will run in same direction*/ 
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i 

Step_A = 2.729 - sin(( double) (A tpha_arm/2.0) - (Pi/4.0)); 

Step_B = 2.729; 

> 

else if (MotorJJumber == 4) /* Move only disk A & B motor: 

disk will run in same direction*/ 

< 

Step_A = -1.0; 

Step B = 1 .0; 

> 


/* Read in actual position of the arm and drum motors for offset */ 
Read_Actual_Pos(Channel_Address,Act _pos); 

Motor_Pos CO] [Frame_count] = Act_pos[0]; 

Motor_Pos[1] [Frame_count] = Act_pos[1); 

Int_Motor_PosB = (double) Ac t_pos[0] ; 

Int_Motor_PosA =(double)Act _pos [1] ; 


Frame_count = Frame_count + 1; 

/* Check to see if range of frame counts is such that both motors will 
be moved together */ 

while (Frame count <= Number of Frames) 
i 

if (Frame count <= Range) 

C 

Int_Motor_PosB = Int_Motor_PosB + Step_B; 

Motor_Pos [0] [Frame_count] = (long int )7nt_Motor_PosB; 

Int_Motor_PosA = I nt_Motor_PosA - Step_A; 

Motor_Pos[1] [Frame_count] = (long int )Tnt_Motor_PosA; 

> 

else if ((Frame_count <= (3*Range)) && (Frame count > Range)) 

C “ 

Int_Motor_PosB = Int _Motor_PosB - Step_B; 

Motor_Pos [0] [Frame_count] = (long int)Int_Motor_PosB; 

Int_Motor_PosA = Int_Motor_PosA + Step_A; 

Motor_Pos7l] [Framecount] = (long int)Int Motor PosA; 

> 

else if ((Frame count <= (4*Range)) && (Frame count > (3*Range))) 
C 

Int_Motor_PosB = Int_Motor_PosB + $tep_B; 

Motor_Pos70] [Frame_count3 = (long int ) Int_Motor_PosB; 

Int_Motor_PosA = Int_Motor_PosA - Step_A; 

Motor_Pos[1] [Frame_count] = (long int )7nt_Motor_PosA; 


else if ((Frame count <= (5*Range)) && (Frame count > (4*Range))> 
C 

Int_Motor_PosB = Int_Motor_PosB - Step_B; 

Motor_Pos70] [Frame_count] = (long int)7nt_Motor_PosB; 

Int_Motor_PosA = Int_Motor_PosA - Step_A;~ 

Motor_Pos [1] [Frame_count] = (long int)Int Motor PosA; 

> 

else if ((Frame_count <= (7*Range)) && (Frame_count > (5*Range))) 

C Int_Motor_PosB = Int_Motor_PosB + Step_B; 

Motor_Pos[0] [Frame_count] =”(long int ) Int_Motor_PosB; 

Int_Motor_PosA = Int_Motor_PosA + Step_A;~ 

Motor_Pos7l] CFrame_count] = (long int)7nt Motor PosA; 

> “ 
else if ((Frame_count <= (8*Range)) && (Frame_count > (7*Range)>) 
( Int_Motor_PosB = Int_Motor_PosB - StepB; 

Motor_Pos C0J [Frame_count] = (long int)Int Motor_PosB; 

Int_Motor_PosA = Int_Motor_PosA - Step_A;~ 

Motor_Pos7l] [Frame_count] = (long int)7nt_Motor PosA; 
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> 

F rame_count = F rame_count + 1 ; 

> 

Motor_Pos[0] [Frame_count] = Motor_Pos CO] [0] ; 
Motor_Pos [1] [Frame_count] = Motor_Pos[1] C03; 

> /* End of CotTpute_Open_Loop_Commands function */ 
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/* Motor. C: controls all functions of the dc servo motors V 

^include <stdio.h> 

^include <conio.h> 

#include <ctype.h> 

#include <time.h> 

^include <graph.h> 

#include <dos.h> 

^include <time.h> 


unsigned Motor_Pair1_Address = 0x300; 
unsigned Motor_Pai r2_Address = 0x306; 
unsigned Motor_Pai r3_Address = 0x310; 


/^Address to first pair of motor 
/^Address to first pair of motor 
/^Address to first pair of motor 


control lers 
control lers 
control lers 


*/ 

*/ 

V 


unsigned Control_word_address = 0x31e; /* Address to which 8255 conmand word 

is being set *f 

unsigned Port_A_Address = 0x318; /* Adress of port A on 8255 */ 

unsigned Port_B_Address = 0x3 la; /* Adress of port B on 8255 */ 

unsigned Port_C_Address = 0x31 c; /* Adress of port C on 8255 */ 


unsigned Control_word = 0x92; 
unsigned Port_373 « 0x30C; 


/*Sets ports A,B to inputs and 
C to outputs */ 

/* Address for 74LS373 latch */ 


/♦Set up all varables that will define the HCTL-1X00 motor controller registors */ 


int Flag_Reg_Address = 0x0000; 
int Prog_Counter_Address = 0x0505; 
int Status_Reg_Address = 0x0707; 


/* Address for writing to flag registor */ 
/* Address of program counter */ 

/* Address of Status Registor V 


int AD_Motor_Com_Address = 0x0808; /* Address at which we can write data 

out to the 8 bit port that feeds 
an A/D */ 


int Pwm_Motor_Com_Address = 0x0909; /* Address at which we can command the 

PWM port of the controller */ 

int Command_Pos3_Address = OxOcOc; /* Address to the MSB of the comnand 

position */ 

int Command_Pos2_Address = OxOdOd; /* Address to the middle byte of the conmand 

position */ 

int Command _Pos1_Address = OxOeOe; /* Address to the LSB of the coomand 

position */ 

int Sampler_T imer_Address = OxOfOf; /* Address for setting up timer in controller */ 

int Actua l_Pos3_Address = 0x1212; /* Address to the MSB of the command to 

read the actual position of the motor */ 

int Actua l_Pos2_Address = 0x1313; /* Address to the middle byte of the conmand to 

read the actual position of the motor */ 
int Actual _Pos1_Address = 0x1414; /* Address to the LSB of the command to 

read the actual position of the motor V 

int Comm_R ing_Address = 0x1818; /* Address to set up the length of commutation 

cycle */ 

int Comm_Vel_T imer_Address = 0x1919; /^Address to command the amount of phase 

advance at a given advance */ 

int X_Address = 0x1 ala; /* Address to command the interval that only 

one phase is active */ 

int Y_Phase_Overlay_Address = Oxlblb; /* Address to command the interval that 

two seq. phase are active */ 

int Of f set_Address = Oxlclc; /* Address to command the relative start 

of the commutation cycle with respect 
to the index pulse V 
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int Max_Phase_Adv_Address = Oxlf If ; /* Address to command upper limit of 

phase advance */ 

int Filter Zero Address = 0x2020; /* Address to set up value for zero in 

digi tal f i Iter */ 

int Filter Pole_Address = 0x2121; /* Address to set up value for pole in 

digital filter */ 

int Fi lter_Gain_Address = 0x2222; /* Address to set gain of the digitial filter */ 

int Comm_Veloci ty1_Address = 0x2323; /* Address to input l SB of command velocity */ 

int Comm_Veloci ty2_Address = 0x2424; /* Address to input MSB of command velocity */ 

int Accel_LSB_Address = 0x2626; /* Address to input ISB of command acceleration */ 

int Accel_MSB_Address = 0x2727; /* Address to input MSB of command acceleration */ 

int Max_Veloci ty_Address = 0x2828; /* Address to max velocity in the trapezoidal 

profile */ 

int Final _Pos 1 _Add ress = 0x2929; /* Address (LSB) to write or read the position 

at which the motor is conmanded to go to V 

int Final Pos2_Address = 0x2a2a; /* Address to write or read the position 

‘ at which the motor is commanded to go to */ 

int Final Pos3_Address = 0x2b2b; /* Address (MSB) to write or read the position 

at which the motor is commanded to go to */ 

int Actual_Vel 1_Address = 0x3434; /* Address (LSB) to read actual velocity of motor V 

int Actual_Vel2_Adrerss = 0x3535; /* Address (MSB) to read actual velocity of motor V 

/* Listed below is all the functions in the program V 

int Read_Fi l ter__Zero( unsigned Motor_Address); 
int D i spl ay_Ma i n_Menu( void); 
void Wait_for_key_P ress (void); 
void Process_Main_Option(int Key_pressed); 
int D i spl ay_Main_Menu( void); 

void Write_Fi l ter_Zero( unsigned Motor_Address, int Fi lter_Zero); 

void Write Fi lter_Po l e( unsigned Motor_Address, int Fi lter_Pole); 

void Wri te’Fi l ter~Gain( unsigned Motor_Address, int Fi lter_Gain); 

int Read_?i lter_Zero(unsigned Motor_Address); 

int Read_Fi l ter_Po l e< unsigned Motor_Address); 

int Read’Fi lter_Gain( unsigned Motor_Address); 

void Wri te_to_8bi t_port( unsigned Motor_Address, int Digital_word); 

void Wri te_to~PWM_port( unsigned Motor_Address, int PWM_data); 

void Wri te_to_samp l er_timer( unsigned Motor_Address, int Sampler_data); 

unsigned Read’s tatus_reg( unsigned Motor_Address); 

void Write_Max Ve l oc i ty( unsigned Motor_Address, int MaxVeloci ty); 

void Wri te_Max~Acce l (unsigned Motor_Address, int *Max_Acc_data); 

void Write to_program counter (unsigned Motor_Address, int Program_counter); 

void Wri te~Fina l_pos( unsigned Motor_Address, long int *Final_data); 

Read_Actual_Pos( unsigned Motor_Address, long int * Actual_pos); 
void Wri te_to_f lag_registor (unsigned Motor_Address, int Flagword); 
void Reset_Actual_Posi tion( unsigned Motor__Address, int Reset_Pos); 

Read_Final_Pos( unsigned Motor_Address, long int *Final_pos); 

int Read Max Accel (unsigned Mot or_Add ress, int *Motor_Acceleration); 

int R eadjlax’ve l ocity (unsigned Motor_Addr ess); 

Read Cominand~Pos( unsigned Motor_Address, long int *Command_pos); 
void’wri te_command_pos( unsigned Mo torAdd ress, long int *Posi tion data); 


/* The following function will be used to write to both the drum and arm 
motor controller at the same time */ 


void Write to motorcontrol l er( unsigned Address, int Dataword, int Registor) 

* outpw (Address , Registor); /*Generate an Ale signal and send over the 

registor address that we want to write 
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to */ 

outpw ((Address + 2), Dataword); /‘Generate chip select and output data */ 

) 

/* The following function will be used to read data from the both 
the drun and motor controllers */ 

int Read_f rom_motor_control ler(unsigned Address, int Registor) 

int Dumb_data, Control ler_data; 

outpw (Address, Registor); /‘Generate an Ale signal and send over the 

registor address that we want to write 
to */ 

Dumb_data = inpw(Address + 2); /‘Generate chip select to motor controller */ 
Control lerjdata = inpw(Address + 4 ); /* Generate OE signal and read data */ 
return Control ler_data; 

> 

/* The following function will write to the flag registor */ 
void Wr i te_to_f l ag_reg i s tor (unsigned Motor_Address, int Flagword) 

Wri te_to_motor_control ler(Motor_Address, Flagword, Flag_Reg_Address); 

> 

/* The following function will write to the program counter*/ 

void Write_to_program_counter (unsigned Motor_Address, int Program_counter) 

Wri te_t o _motor_control ler(Motor_Address # Program_counter,Prog_Counter_Address); 

> 

/* Th e following function will write to the status registor*/ 
void Wri te_to_status_reg( unsigned Motor_Address, int Statusword) 

Wri te_to_motor_control ler(Motor_Address, Statusword, Status_Reg Address); 

> 

/* The following function will read the status registor*/ 

unsigned Read_status_reg( unsigned Motor Address) 

C 

unsigned Status; 

Status = Read_from_motor_control ler(Motor Address, Status Reg Address)* 
return Status; “ “ “ ' 

> 

/* The following function will write to the 8 bit port*/ 
void Wr i te_to_8bi t_port(unsi gned Motor_Address, int Digi tal_word) 

Wri te_to_motor_control ler(Motor_Address,Digi tal_word,AO_Motor_Com_Address); 

> 

/* The following function will read the data in the 8 bit port*/ 

int Read_8bit_port( unsigned Motor Address) 

C 

int Port_data; 

Port_data = Read_f rom^motor_control ler(Motor_Address,AD_Motor Com_Address); 
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return Port_data; 

) 

/* The following function will write data to the PWM port / 
void Write_to PWM_port( unsigned Motor_Address, int PWM_data) 

i Wri te_to_motor_control ler(Motor_Address,PWM_data,Pwm_Motor_Com_Address ); 

} 

/* The following function will read the data from the pwm command registor*/ 

i nt Read_PUM_port( uns i gned Mot or_Address ) 

l 

PWM Port^data = RMd_fromjiK>tor_controUer(Motor_Address,PwmJ1otorj:om_Addres$); 

return PWM_Port_data; 

> 


/* The following function will write data to the Comnand position registor*/ 


void Ur ite_conmand_posC unsigned Motor_Address, long int *Position_data) 

< 

long int New_Pos_Data[2] ; 
int Posjdata = 0; 

/★ invert the sign of the comnand if channel 1 is written to */ 
if (Motor_Address == Motor_Pai rl^Address) 

New_Pos_Data[0] = Posi tion_data[0] * -1; 

New~Pos_Data [1] = Posi t ion_data El] * -1; 

> 

else 

New_Pos_Data[03 = Posi tion_data[03 ; 

New~Pos_Data[13 = Posi t ionjdata [1] ; 


/* Output the most significant byte to the nx»tor '° ntr ? lle !! V ^ <, nvf*o(m- 

Pos data = (((New Pos DatatO] » 16) & Oxff) | ((New_Pos_Data[1] » 8 & OxffOO)), 

Write to motor_controTler(Hotor_Address,Pos_data,Comnand_Pos3_Address); 


/* Output the middle byte to the motor controller */ 

Pos data = ( ( New_Pos_Dat a 103 » 8) t Oxff) | (New J>os Datall] & OxffOO); 

Write_to motor_cont roller (Motor_Address, Postdate, Confnand_Pos2_Address), 

/* Output the least significant byte to the motor controller*/ 

Pos data = <<NewJ>os_Data[0] & Oxff) | <New_PosJ)ata[1) « 8) & OxffOO) 
Write tomotorcont ro l ler (Motor_Address , Postdate , Command_Pos1_Address ) ; 


> 


/* The following function will read the comnand motor position registor*/ 
Read Command_Pos( unsigned Motor_Address, long int *Comnand _pos ) 

C 


int Comdatal ,Com_data2,Com_data3; 

/* Read the most significant byte of the comnand position from the motor controller */ 
Comdata3 = Read_f rom_motor_control ler(Motor^Address,Comnand_Pos3_Address); 

/* Read the middle byte of the comnand position from the motor controller */ 

Com data2 = Read_f rom_motor_control ler(Motor_Address,Comnand_Pos2_Address); 

/* Read the least significant byte of the comnand position from the motor controller */ 
Com datal = Read_f rom_motor_control ler<Motor_Address,Comnand_Pos1_Address); 
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/* Determine actual pos for drum motor */ 

Comma nd_pos [0] = Com_data3 & Oxff; 

Command jx>s [0] = (Command_pos [ 0 ] << 8) I (Com data2 & Oxff); 
Comma nd_pos [0] = (Command jx>s [ 0 ] « 8) | (Confdatal & Oxff); 

/* Determine actual pos for arm motor */ 

Command_pos [1] = Com_data3 & OxffOO; 

Command_pos [13 = (Command_pos [1] « 8) | (Com data2 & OxffOO); 
Comma nd_pos [1] = ( Comma nd_pos [ 1 ] | ((Com_dataT & OxffOO) » 8 )); 

if (Motor_Address == Motor_Pair1_Address) 

Command _pos CO] = Commar>d_pos [0] * -1; 

Comma nd_pos [1 ] = Comma nd_pos [1] * -1; 




/* The following function will write data to the Sanpler timer registor*/ 
void Write_to_sampler_timer( unsigned Motor_Address, int Sanpler_data) 

C 

/* Output the timer value to the motor controller */ 

Wri te_tojnotor_control ler(Motor_Address,Sampler_data, Sampler_Timer_Address); 


/* The following function will read the actual motor position registor*/ 
Read_Actual_Pos( unsigned Motor_Address, long int * Actual _pos) 
t 


int Actual_data1 , Actual _data2, Actual _data3; 

/* Reac * least significant byte of the command position from the motor controller 
Actual_data1 = Read_f rom_motor_control Ler(Motor_Address,Actual_Pos1_Address); 

/* Read the middle byte of the command position from the motor controller */ 
Actual_data2 = Read_f rom_motor_control ler(MotorJlddress,Actual_Pos2_Address); 

/* Read the most significant byte of the command position from the motor controller 
Actual_data3 = Read_f rom_motor_control ler(Motor_Address,Actual _Pos3_Address); 

/* Shift and or the data read from motor controller and store in a 21 byte 
word */ 

/* Determine actual pos for drum motor */ 

Actual_pos [0] = Actual_data3 & Oxff; 

Actual_pos [0] = (Actual_pos [0] << 8) I (Actual data2 & Oxff); 

Actual_pos [0] = (Actual_pos [0] « 8) | (Actual~data1 & Oxff); 

if (Actual_pos [03 > 0x7fffff) 

Actual _pos[0) - = Oxffffff; 

/* Determine actual pos for arm motor */ 

Actual_pos [1] = Actual_data3 & OxffOO; 

Actual_pos [1] = (Actual _pos[1] « 8) | (Actual data2 & OxffOO); 

Actual_pos [1] = (Actual _pos[1] | ((ActualjdataT & OxffOO) » 8)); 

if (Actual _pos [1] > 0x7fffff) 

Actual _pos[1] -= Oxffffff; 

if (Motor_Address == Motor_Pair1 Address) 

< 

Actual_pos [0) = Actual_pos [0] * -1; 

Actual^pos [1] = Actual _pos[1] * -1; 
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/* jhe following function reset the actual position registor / 
void Reset_ActualJ>osition(unsigned MotorAddress, int Reset_Pos) 

* /* Write to registor 13H to reset actual position counter */ 

Write to motor_cont roller <Motor_Address,ResetJ>os,Actual J>os2_Address); 


/* jhe following function writes the zero of the di gi t i at filter to the 
to the motor controller */ 

void Wri te_Fi lter_Zero(unsigned Motor_Address, int Filter_Zero) 

1 Write to motor_controller(Hotor_Address,Fi lter_Zero, Fi lter_Zero_Address>; 


/* The following function will read value of the registor that contains the 
zero of the digitial filter*/ 

int Read_Fi tter_Zero< unsigned Motor_Address) 

i 

int Zero; 

Zero = Read_f rom_motor_cont ro 1 1 er ( Motor_Address , F i l ter_Zero_Addr ess ) ; 
return Zero; 

> 


/* The following function writes the pole of the digitial filter to the 
to the motor controller */ 

void Write_Fi l ter_Pole< unsigned Hotor_Address, int Filter_Pole) 

i Write tojTWtor_controller(Motor_Address f Fi Iter J>ole, Filter J>ole_Address); 


/* The following function will read value of the registor that contains the 
pole of the digitial filter*/ 

int Read_Fi l ter_Po l e( unsigned Motor_Address) 

i 

int Pole; 

Pole = Read_f rom_motor_control ler(Motor_Address, Fi lter_Pole_Address); 
return Pole; 

> 

/* The following function writes the Gain of the digitial filter to the 
to the motor controller */ 

void Wr i t e_Fi l ter_Gain< unsigned Motor_Address, int FilterJSain) 

Write to motor control l er(Motor_Address,Fi lter_Gain,Fi lter_Gain_Address) 

> 


/* The following function will read value of the registor that contains the 
gain of the digitial filter*/ 
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int Read_Fi l ter_Gain( unsigned Motor_Address) 

L 

int Gain; 

Gain = Read_f rom_motor_cont roller (Hot or_Address, Fi l ter Gain_Address); 
return Gain; 

> 


/* The following function will write data to the Max Acceleration registor*/ 

void Wri te_Max Accel (unsigned Motor Address, int *Max Acc data) 

{ “ “ 
int Acc_data = 0; 

I* Output the most significant byte to the motor controller */ 

Acc_data = ( (Max_Acc_data CO] » 8) & Oxff) | (Max_Acc dataCI) & OxffOO); 

Wri te_to_motor_control ler(Motor_Address,Acc_data, Accel J1SB_Address>; 

/* Output the least significant byte to the motor controller */ 

Acc_data = (Max_Acc_data(0] & OxOOff) | (Max_Acc_data [1] « 8); 

Wri te_tojnotor_control ler(Motor_Address, Acc_data, Accel J.SB_Address); 

> 


/* The following function will read the Maximum acceleration registor*/ 
int Read_Max_Acce l (unsigned Motor_Address, int *Motor_Acceleration) 

< 

int Accel_data1,Accel_data2; 

/* Read the most significant byte max. acceleration from the motor controller */ 
Accel_data2 = Read_f rom_motor_control ler(Motor_Address,Accel_M$B_Address); 

/* Read the .east significant byte of the command position from the motor controller */ 
Accel_data1 = Read_f rom_motor_control ler(Motor_Address,Accel _LSB_Address); 

/* Shift and or the data read from motor controller and store in a 21 byte 
word */ 

Motor_Accelerat i on [0] = Accel_data2 & Oxff; 

Motor_Accelcration[0] = (Motor_Accelerat ion[0] « 8) | (Acceljdatal & Oxff); 
Motor_Acceleration[1] = Accel_data2 & OxffOO; 

Motor_Accelerat ion [1] = Motor_Acceleration[1] | <<Accel_data1 & OxffOO) » 8); 


/* The following function writes the Max Velocity for trapezoidal mode to the 
to the motor controller */ 

void Wri t e_Max_Ve l oc i ty( unsigned Motor_Address, int MaxVelocity) 

< 

Wri te_to_motor_control ler(Motor_Address,MaxVeloci ty # Max_Veloci ty_Address); 


/* The following function reads the value of the registor that contains the 
Max velocity for trapezoidal mode*/ 

int Read_Max_Ve l ocity( unsigned Motor_Address) 

i 

int Velocity; 


FILE: D:\TEMP\MOTOR.C 

Size: 19986 Edited: 7-21*92, 3:55p 


Page: C68 

Printed: 11-17*92, 1:43p 


518 

519 

520 

521 

522 

523 

524 

525 

526 

527 

528 

529 

530 

531 

532 

533 

534 

535 

536 

537 

538 

539 

540 

541 

542 

543 

544 

545 

546 

547 

548 

549 

550 

551 

552 

553 

554 

555 

556 

557 

558 

559 

560 

561 

562 

563 

564 

565 

566 

567 

568 

569 

570 

571 

572 

573 

574 

575 

576 

577 

578 

579 

580 

581 

582 

583 

584 

585 

586 

587 

588 

589 

590 

591 


Velocity = Read_from motor_control ler(Motor_Address,Max_Veloci ty_Address), 
return Velocity; 

> 


/* The following function will write data to the Final position registor*/ 

void Wri te_Fina l _pos( unsigned Motor_Address, long int *Final_data) 

C 

long int New_f inal_data[2] ; 
int Fin_data = 0; 


if (Motor_Address == Motor_Pai r1_Address) 
C 

New_f inal_data[0] = Final_data[0] * *1; 

New”f i nal_data [1 ] = Final_data [1] * -1; 

> 

else 


New_f inal_data [0] = Final_data[0] ; 
New f inal_data [1] = Final_data[1] ; 


/* Output the most significant byte to the motor controller */ 

Fin_data = <((New_f inal_data[0J » 16) & Oxff) | <(New_f inaljdata [1] 
Write to_motor_control ler(Motor_Address, Fin_data, Final_Pos3_Address); 


» 8) & Oxff 00)) 


/* Output the middle byte to the motor controller */ 

Fin_data = ( ( New_f i na l_data CO] » 8) & Oxff) | <New_f inaljdata [1] & OxffOO); 

Write to motor_control ler(Motor_Address,Fin_data,Final_Pos2_Address); 


/* output the least significant byte to the motor controller */ 

Fin data = ((New_f inal_data[0] & Oxff) | (New_f inal_data[1] « 8) & OxffOO) ; 
Write to_motor control ler(Motor_Address,Fin_data,Final_Pos1_Address); 


> 


/* The following function will read the Final motor position registor*/ 

Read_F i na l_Pos( uns i gned Motor_Address, long int *Final_pos) 

int F i na l_data1 , F i na l_da ta2 , F i na l_data3; 

/* Read the most significant byte of the command position from the motor controller */ 

F inal_data3 = Read_f rom_motor_control ler(Motor_Address, Final_Pos3_Address); 

/* Read the middle byte of the command position from the motor controller */ 

Final data2 = Read_f rom_motor_cont roller (Motor_Address, F inal_Pos2_Address ); 

/* Read the least significant byte of the command position from the motor controller */ 
Final_data1 = Read_f rom_motor_control ler(Motor_Address, Final _Pos1_Address); 

/* Determine the final position of the drum motor */ 

Final_pos [0] = FinaljJata3 & Oxff; 

Final_pos[0] = ( F i naT_pos [0] « 8) I <Final_data2 & Oxff); 

Final_pos [0] = (Final_posE0) « 8) | (Final_data1 & Oxff); 

/* Determine final position of the arm motor */ 

Final jx>s[1] = Final data3 & OxffOO; 

Finalpostl] = (FinaT_pos [1) « 8) | (Final_data2 & OxffOO); 

Final_pos[l3 - (Final_pos [1] | ((Final_data1 & OxffOO) » 8)); 

if (Motor_Address == Motor_Pai r1_Address) 

t 

Final jx>s [0] = Final_po$[03 * -1; 

Final_pos [1] * Final_pos[13 * *1; 

> 
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592 if (F inal_pos [0] > 0x7fffff> 

593 Finat_pos [0] -= Oxffffff; 

594 

595 if (Final_pos[11 > 0x7fffff) 

596 Final_pos[1] -= Oxffffff; 

597 

598 

599 > 

600 
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1 

2 /* Oi splay routine is used to provide the menu for manual control of the motors */ 

3 

4 #include <stdio.h> 

5 #include <conio.h> 

6 #inctude <ctype.h> 

7 #include <time.h> 

8 #include <graph.h> 

9 #include <dos.h> 

10 #include <time.h> 

11 #include <stdlib.h> 

12 #include <math.h> 

13 #include <cport.h> 

14 

15 #def ine LEFTARROW 75 

16 #def i ne RIGHTARROU 77 

17 #def ine UPARROU 72 

18 #def i ne DOWNARROW 80 

19 

20 

21 signed char output_buffer [512] ; 

22 signed char input_buf fer [1024] ; 

23 unsigned int rs; 

24 int BLK_SZ = 8; 

25 

26 /* Declare the following variables external these var. are declared in motor. c */ 

27 extern unsigned Motor_Pai r1_Address; /^Address to first pair of motor controllers */ 

28 extern unsigned Motor_Pai r2_Address; /*Address to first pair of motor controllers */ 

29 extern unsigned Motor Pai r3~Address; /^Address to first pair of motor controllers */ 

30 

31 extern unsigned Port_A_Address; /* Adress of port A on 8255 V 

32 extern unsigned Port~B_Address; /* Adress of port B on 8255 */ 

33 extern unsigned Port“c_Address; /* Adress of port C on 8255 */ 

34 extern int Set_to_actual; 

35 extern int C_PortJ)ata; 

36 

37 extern long int Starting_Posi t ion[2] [3] ; 

38 extern long int Current_Posi t ion[23 C3] ; 

39 

40 extern int Stop_Serial_Data[3] ; 

41 extern int Ini tiate_Serial_Tran[3] ; 

42 

43 extern struct Channel_data 

44 L 

45 unsigned Time_tag; 

46 double Elevation^error; 

47 double Azimuth_error; 

48 double S igna ^strength ; 

49 signed char Transmi t_Data; 

50 > Channel [3] , Test [3] ; 

51 

52 long int timelasped; 

53 

54 int Exercise Multiple ChannelsCint *Channels_to_Exercise) 

55 C 

56 int Switch number_array [3] [5] = {<3, 4, 5, 6, 3>,C9, 10,11,12,9}, 05, 16, 17, 18, 15)>; 

57 long int Deltajnove array[33 [4] = {{-500, 40, 0,500), {-500, 40,0, 500), C-500, 40, 0,500}}; 

58 long int Alphajnovelarrey C3] [4] = {{0, 100, -100,0}, {0,100, -100,0), {0,100, -100,0}}; 

59 long int Alpha_move_only = {40}; 

60 long int Deltajnove = {0}; 

61 int numb_sw itch, chan jxjmber, Ac tivated_swi tch, Address, Move_f ini shed; 

62 long int Target_Position[23 ; 

63 long int Posi tion_of_Motor [2] ; 

64 int exit_loop = {0}; 

65 

66 while (kbhitO) getchO; /* clear out keyboard buffer * 

67 

68 /* Start all requested channels running */ 

69 numb_switch = 4; 

70 

71 for (chan number = 1; chanjiumber <=3; chan_number++) 

72 { 

73 if (Channe l s_to_Exercise [chanjiumber] == 1) 
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< 

switch (chan_number) 

( 

case 1 : 

( Address = Motor_Pair1 Address; break;} 
case 2: 

{ Address = Motor_Pair2 Address; break;} 
case 3 : 

C Address = Motor_Pair3_Address; break;} 


Move_Mot or (Address, A Lpha_n»ve_array [chan_number- 1] [nurb switch-1] 
Delta_move_array[chan_number-1] [numb_switch-1] ); 

printf ("\nMoving channel Xi to limit switch Xi”,chan nunber, 

Swi tch_nunber_array[chan_nunber-1] [numb_swi tch] ); 

} /* End of if Channels_to_Exercise[chan number] == 1 */ 

} /* End of chan_number <= 3 */ 


while (exit l oop ! = 1 ) 

< 

for (chanjurober = 1; chan_number <=3; chan_number++) 


if (kbhitO) exi t_loop = 1; 

while (kbhitO) getch(); /* clear out keyboard buffer 
if ( Channe l s_t o_Exerc i se [chan_number] == 1) 


for (numb_swi tch = 1; numb switch 

< 


4; numb_switch++) 


V 


Acti vated_swi tch = Check_for_switch_Activation(Switch_number_array 
[chan_number-1] [numb_swi tch-1] ); 

if (Act i vated_swi tch == 1) 

C 

/* Delay program till motor stops */ 

for (timelasped = 60000; timelasped > 0; timelasped = timelasped - 1) 

switch (chan_number) 

< 

case 1 : 

C Address = Motor_Pair1_Address; 

Alpha_move_only = 25; 
break; 

} 

case 2: 

{ Address = Motor_Pair2_Address; 

Alpha_(T>ove_only~= 40; 
break; 

} 

case 3: 

C Address = Motor_Pair3j*ddress; 

ALpha_move_onty = 55 
break; 

} 

} 

if (numb_swi tch == 4) 

/* Stop motors and set to actual position */ 

Set_Motor_Pos i t i on( Address , Set_to actua l ) ; 

Read_Ac tual_Pos( Address, Pos i t ion of_Motor); 

Target_Position[03 = (Alpha_move_only * 769) + Position of MotorfO]* 
Target_Positiont1J = Position_of_Motor[ 1 ]; 

M°v e _M°tor(Address,Alpha_move only, Delta move); 

Move_f ini shed = 0; 

/* Wait for arm to swing over before continuing */ 
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while (Move_f ini shed != 1) 
Move_f ini shed = Reached^ 
> /* End of nunb_swi tch == 


Commanded^Pos (Address, T a rget_Posi t ion, chan — number, 30); 

4 */ 


Hove Motor ( Address , A t pha_move_a rray [charwumtoer- 1] tnunb switch- 1] , 
Delta move arraylchan number- 1 } [numb_swi ten- ij ), 


printf ("\nMoving channel %i to limit switch xi "» chan - n y i J 1 ^ r 
Switch number_array [chan_number- 1] [numb_swi ten] ); 


if (kbhitO) exitjoop = 
while (kbhitO) getchC); 


' /* clear out keyboard buffer */ 


> /* End of if act ivated_sw itch == 1 */ 

) /* End of numb_swi tch <= 4 */ i */ 

> /* End of Channe l s_to_Exerc i se [chan_nunber] == i / 
> /* End of chan_number <=3 */ 

> /* End of exit_loop != 1*/ 

/* Stop motors and reset all positions counters to zero V 
for (chanjiumber = 1; chan_number <=3; chan_number++) 

switch (chan_number) 

^case 1: Address = Motor _Pai r1_Address; 
case 2: Address = Motor_Pai r2_Address; 
case 3: Address = Motor_Pai r3_Address; 

Set_Motor_Posi tion( Address, Set_to_actual); 

> 


> /* End of function */ 


int Move_Hotor( uns i gned Motor_Address, long int Move_to_Alpha, long int Move_to_Delta) 


< 

long int Actual_Pos [23 ; 
l ong i nt New_Pos [23 ; 


/* Stop motors and set to actual position */ 

Set Motor_Position(Motor_Address,Set_to_actual); 


/+ Delay reading of motor till it as a chance to move V 

for (timelasped = 50000; timelasped > 0; timelasped = timelasped - 1), 


Read Actual_Pos(Motor_Address,Actual_Pos); 


/♦Set up positions for the move command V 

/★ Add delta to Disk B and Disk A motor position */ 

New Pos [03 = (Hove to Alpha * 769) + (1967 * Move_toJ)elta) + 
New~Pos [13 = ActuaI_Pos [13 - (1967 * Move_to_Delta); 


Actual Pos [03; 


/* output new position to the motor controller */ 
Wr i te_F i na l_pos ( Motor_Address , New_Pos ) ; 


/* Start trapozoidal move */ 

Write to_f lag_registor ( Mo to r_Address, 0x0808); 


/♦ Delay continuing till of motor till it as a chance to move */ 

for (timelasped = 100000; timelasped > 0; timelasped = timelasped - 1); 


> 

void Position( double Azimuth, double Elevation, int channel, 
unsigned Motor_Address, int Incremental) 


double Delta[43 , Alpha[4) , AZJ)eg,EL_Deg, Command^Length, Upscale, V_Sca l e; 

double Level_of_Signal ,Level_of _UError,Level_of_VError; 

long int I_StepA[4), I_StepB(43, $tepj)if; 
long int Command^ Pos [23 ,Actual — Pos[23 ; 
int a,b, Number_of_Solutions, loop, Solution; 
long int Present_Delta = 10000000; 
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int t = 1; 

long int time_out; 

int Numb_of_Chan, Loop_count; 

Loop_count = 0; 

Levet_of_Signal = 0; 

Level_of JJError = 0; 

Level_of_VError =0; 

AZJ)eg = (Azimuth) * 57.29577951; 

EL_Deg = (Elevation) * 57.29577951; 

AzE l 2AB( Azimuth, Elevation, I_StepA, I_StepB, Delta, Alpha, &Nuit>er_of_SoLut ions); 

for (loop=0; loop <= Number_of_Solutions; loop**) 

Step_Dif = Current_Pos i t i on [1 ] [channel - 1 ) - I StepACloop]; 
if (labsCStep Dif) < Present Delta) 

Present_Delta = labs(Step_Di f ); 

Solution = loop; 

> 

) 

_clearscreen( _GCLEARSCREEN ); 

printf ("Use cursor keys to move the head in the X and Y coordi nates. \n"); 
printf ("Press *E ' to exit. \n"); 

Read_Actual_Pos(Motor_Address,Actual_Pos); 

Actual_Pos [0] = Start ing_Positi on [0] [channel-1] - Actual_Pos [0] ; 

Actual_Pos[1] = Starting_Posi t ion[1] (channel-1) + Actual_Pos[1] ; 

if (channel == 1) Numb_of_Chan = 2; 
else if (channel == 2) Numb_of_Chan = 1; 
else Numb_of_Chan = 3; 

if (channel == 3) 
i 

U Scale = - 0.0002718; 

V_Scale = 0.0002453; 

> 

else 

U Scale = 0.0002718; 

V_Scale = - 0.0002453; 


do 

_settextposi t ion(4,5); /^Position the cursor at position 1,5)*/ 

AZ_Deg = (Azimuth) * 57.29577951; 

EL_Deg = (Elevation) * 57.29577951; 

printf ("Channel %i Posi t ion\n",Numb_of_Chan); 
printf ("\n\tAzimuth: %8.6f Elevation: X8.6f\n", 

AZ_Deg, EL Deg); 

printf ("\n\tDelta: %10.6f Alpha: X10.6f\n», 

Delta [Solution] , Alpha [Solution] ); 
printf ("\n\tI_StepA: XI i I_Stepfl: Xli\n», 

I_StepA [Solution] , I_StepB [Solution] ); 
printf ( M \n\tActualA: XI i ActualB: Xli\n», 

Actual_Pos [1] ,Actual_Pos [0] ); 

do ( 

/* Turn DSP for data retreival */ 

C_Port_Data = C_Port_Data | Ini tiate_Serial_Tran[channel - 1]; 
outp( Por t_C_Address , C_Por t _Dat a ) ; 

ComF lushRxC ); /* Flush out data before starting loop */ 

time_out = 0; 
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/* Wait for data before reading out data */ 

white ((ComLenRxO < BLK_SZ) && <time_out <= 50000)) 

time_out - time_out + 1; 

if (time_out < 50000) 
i 

Read_Channel_Data(&Test [channel - 1]); 

/* Clear out keyboard buffer before continuing */ 
else 
< 

while (kbhitO) b = getchO; 

ComFlushRx( ); 

> 

/* Turn off sync pulse to x channel */ 

C_Port_Data = C_Port_Data & Stop_Ser i a l_Data [channel - 1]; 
outp(Port_C_Address,C_Port_Data); 

Level_of_$ignal = Test [channel- 13 .Signs l_strength/204. 7 + Level_of_Signal; 

L eve l _of JJError = Test [channel -1] .Azimuth_error*U_Scale + Level_of_UError; 
Level of VError = Test [channel-1] .Elevat ion_error*V_$cale + Level_of_VError; 
Loop_count++; 

if (Loop_count == 10) 

_settextposi tion(16, 1 ); /^Position the cursor at position 1,5)*/ 

pr intf ( n \n\tT ime_tag = Xu\t Signal Level: %10.6f\n". 

Test [channel -1] .Time_tag, 

Leve L_of_S i gns l /Loop_count ) ; 

printf ( M \n\tU_Error : %10.6f \t V_Error: %10.6f \n H , 

Level_of JJError /Loop_count , 

Leve l_of _VE r r or / L oop_count ) ; 

Level_of_Signal = 0; 

Leve l _of JJError = 0; 

Level_of_VError = 0; 

Loop_count = 0; 

> 


> while (IkbhitO); 
a=getch(); 

if (a==0) a=getch(); 
switch(a) 

{ case LEFTARROW: Azimuth+=10e-6; 




break; 

case 

R1GHTARR0W: 

Azimuth-=10e-6; 

break; 

case 

UPARROW: 

Elevation-=10e-6; 

break; 

case 

DOWNARROW: 

Elevation+=10e-6; 

break; 

case 

■4': 

Azimuth+=100e-6; 

break; 

case 

*6* : 

Azimuth-=100e-6; 

break; 

case 

■2': 

E l eva t i on+=1 00e-6; 
break; 

case 

*8*: 

E l evat i on- = 1 OOe - 6 ; 
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break; 


default: break; 

> 

Read_Actua l_Pos(Motor_Address , Actua L_Pos ) ; 

Actual_Pos[0) = Starting_Position[0] [channel-1] - Actua l_Pos [0] ; 
Actual_Pos [1] = Starting_Position[1] [channel-1] + Actual~Pos [1] ; 


AzEl2AB(Azimuth, Elevation, I_StepA, I_Step6, Delta, 
Alpha,&Number_of_Solut ions); 

/* Search for the nearest solution */ 

Present_Delta = 10000000; 

for ( loop=0; loop <= Number of_Solutions; loop**) 

{ 

Step_Dif = Actual_Pos [1] - l_StepA [loop] ; 
if (Labs(Step DifT < Present_Del ta) 

L 

P resen t_Delta = labs(Step_Dif); 

Solution = loop; 

) 

) 


/* Set up the commanded position for the DiskB Motor */ 

Command_Pos [0] = Start ing_Posit ion [0] [channel-1] - I_StepB [Solution] ; 

/* Set up the commanded position for the DiskA Motor */ 

Commar>d_Pos[1] = (-1 * Starting_Posi t ion [1] [channel -1] ) + I_StepA[Solut ion) ; 

/* Output new position to the motor controller */ 

Wr i t e_F i na l _pos (Mot or_Address , Comma r»d_Pos ) ; 

/* Start trapozoidal move */ 

Wr i te_to_f l ag_reg i stor (Motor_Address, 0x0808) ; 

while (kbhitO) b = getchO; 

> while < ( a ! = 1 e ' ) && (a* = 'E 1 ) ) ; 

> 


void Run_Scan_Pattern(double Azimuth, double Elevation, int channel, 
unsigned Mot or_Address, double trip_point) 

{ double Delta[4], Alpha [4] ,AZ_Deg,EL Deg,Command_Length; 
long int I_StepA[4], I_StepBT4) , Step_Dif; 
long int Command_Pos [2] , Actua l_Pos [2] ; 
int key,b, Number_of_Solutions, loop, Solution, change_par; 
long int Present_Del ta = 10000000; 
int t = 1; 

long int t ime_out, loop_count , setpoint; 
int exit = 0; 

AZ Deg = (Azimuth) * 57.29577951; 

EL_Deg = (Elevation) * 57.29577951; 

_clearscreen( _GCLEARSCREEN ); 

AzE l2AB(Azimuth, Elevation, I_StepA, IStepB, Delta, Alpha, &Number_of_Solut ions); 

for (loop=0; loop <= Number_of_Solut ions; loop++) 

L 

Step_Di f = Current_Position[1) [channel -1] - I StepACloop]; 
if ( labs(Step_D if) < Present_Del ta) 

Present_Del ta = labs(StepJ)if ); 

Solution = loop; 

> 
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> 

Read_Actual_Pos(Motor_Address,Actual_Pos); 

Actual Pos[03 = Start! ng_Posit ion [0] [channel-1] - Actual_Pos [03 ; 

Actual*~Pos [13 = Start ing_Posit ion [13 Cchannel-1] + Actual_Pos [13 ; 

setpoint = 0; 

Test [channel -13 .Signal_strength = 0.0; 

while ((Test [channel -13 .Signal_strength/204.7 < trip_point) && (exit == 0)) 

for (change_par = 1; changej>ar <= 4; change_par++) 

< 

/* Exit if signal Level is above trip point */ 
if (((Test [channel -13 .Signal_strength /204.7) > trip_point) j| (exit == 1))break; 

if ((change_par == 1) || <change_par == 3)) 
setpoint = setpoint + 1; 

for (loop_count = 1; loop_count <= setpoint; loop_count++) 

< 

if (kbhitO) 
i key = getchO; 

if ((key == 'e') || (key == *E')) exit = 1; 

> 

_set t extpos i t i on( 2,5); /^Position the cursor at position 1,5)*/ 

AZ_Deg = (Azimuth) * 57.29577951; 

ELJ)eg = (Elevation) * 57.29577951; 

pri ntfC'Posi t ion :\n\t Azimuth : X8.6f Elevation: %8.6f\n", 

AZ__Deg, EL_Deg) ; 

printf ("\n\tDel ta: %10.6f Alpha: X10.6f\n", 

Del tatSolution) , Alpha [Solution) ); 
printf (*'\n\t I _StepA: XLi I_StepB: Xli\n”, 

I_StepA [Solution) , I_StepB [Solution] ); 
printf ("\n\tActualA: XI i ActualB: Xli\n", 

Actual_Pos [13 ,Actual_Pos [03 ); 
printf ("\n\t Signal strength = X3.6f H , 

Test [channel-1) .Signal _strength/204 .7 ); 

/* Turn DSP for data retreival V 

C_Port_Data = C_Port_Data | Ini t i ate_Seri a t_T ran [channel - 13; 
outp( Port_C ^Address , C_Por t _Data) ; 

ComFLushRxO; /* Flush out data before starting loop V 

time-out = 0; 

/* Wait for data before reading out data */ 
while ((ComlenRxO < BLK_SZ> && (time-out <= 80000)) 
time-out = time_out ♦ 1; 

if (time_out < 80000) 

Read_Channe l _Data(&Test [channel - 13); 
else if (time-out >= 80000) ComFLushRxO; 

/* Turn off sync pulse to x channel V 

C Port_Data = C_Port_Data & Stopper i a IJJata [channel - 1); 
outp(Port_C_Address , C _Port_Data) ; 


/* Break out of for loop if signal is large enough */ 

if (((Test [channel -13 .Signal_strength /204.7) > trip_point) || (exit == D) break; 
swi tch( change _par) 

C case 1: Azimuth+=50e-6; 

break; 

case 2: Elevation+=50e-6; 

break; 

case 3: Azimuth-=50e-6; 

break; 
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case 4: E levat ion-=50e-6; 

break; 

default: break; 

> 

Read_Actua l_Pos(Motor_Address,Actual_Pos); 

Actual_Pos [0] = Starting_Posi tion[0] [channel -1] - Actual Pos[0]; 

Actual_Pos[1] = Starting_Position[1J [channel-1] + Actual~Pos [1] ; 

AzE l2AB(Azimuth, Elevation, I_StepA, I_Step8, Delta, 

Alpha, &Number_of _So l ut i ons ) ; 

/* Search for the nearest solution */ 

Present_Del ta = 10000000; 

for (loop=0; loop <= Number_of_Solutions; loop++) 

Step J) if = Actual_Pos [1] - I_StepA [loop] ; 
if (labsCStep Dif) < Present Delta) 
t 

Present_Del ta = labs(Step_Dif ); 

Solution = loop; 

> 

> 

/* Set up the commanded position for the DiskB Motor */ 

Command_Pos [0] = Start ing_Posit ion [OHchannel - 1] - I_Stepfl [Solution] ; 

/* Set U P the commanded position for the DiskA Motor */ 

Command_Pos[1] = (-1 * Starting_Posit ion[1] [channel -1) ) + I_StepA [Solution] 

/* Output new position to the motor controller */ 

Wr i te_F inal __pos(Motor_Address,Command_Pos); 

/* Start trapozoidal move */ 

Wri te_to_f lag_registor ( Mo t o r_Addr ess, 0x0808); 

> /* End of for (loop_conut = 1; loop_count <= setpoint; loop count++) */ 

>/* End o for (change_par = 1; change_par <4; change_par++) */ 

/* Turn off sync pulse to x channel */ 

C_Port_Data = C_Port_J)ata & Stop_Serial Data[channel - 1] ; 
outp(Port_C_Address,C_Port_Data); 


> 
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The following include statements are required to allow 
program to link up with Turbo C++ libraries */ 

^include <cport.h> 

#include <bios.h> 

#include <conio.h> 

^include <dos.h> 

#include <ctype.h> 

#include <stdio.h> 

#include <math.h> 

#define BLK_SZ 8 

signed char outputjxif fer [512] ; 
signed char input_buffer[1024] ; 
unsigned int rs; 

int V_er ror , U_error , Tota l_s i gna l_s t rength; 

i nt F r ame_count , Nunbe r_of _sampl es , T ogg l e_count , Process_da t a_f l ag , T l 

char Mode flag; . 

char tmpbuf [128] ; /* Char array for storing time data / 

char tmpbuf 1 C 1 28] ; /* Char array for storing time data / 

struct Channel_data 

{ 

unsigned Time_tag; 
double V_error; 
double iferror; 
double sT gna l _s t r eng t h ; 
signed char Transmit_Data; 

) Channel [3] , Test [3] ; 

double Offset = .03; 

extern unsigned Port_A_Address; 
extern unsigned Port_B_Address; 

extern unsigned Port_C_Address; ^ 

extern FILE *outputjatr; /* Pointer for file to output error data / 

void Ini t_Com_port(void); 

void Read_Channel Data(struct Charvnel_data *Ch_ptr); 
int Test_Ser i a l_Llnk( i nt Chan Jl umber, int Port_CJ)ata); 

/* Read_Channel_Data reads in the data and formats as required */ 
void Read ChanneTDataCstruct Channel_data *Ch_ptr) 


/* Read data from dsp via com port*/ 
rs = ComIn< input _buf fer, BLK_$Z); 

/* send over data to the monitor PC */ 

ComActive(COM2); 

ComOut (&(Ch_ptr->T ransmi t_Data) , 1 ); 

ComOutC input_buffer,rs); 

ComAct ive(COM3); 

/♦Convert input data to 16 bit format for time tag 
input_buf fer [0] and inputjauffer [13 time tag data*/ 

Ch_ptr->Time_tag = ( int) input_buffer [13 ; 

Ch_ptr->Time tag = (Ch_ptr->Time_tag & Oxff) « 8; 
Ch_ptr->Time~tag += ( int) input Jxif fer [03 & Oxff; 

/* Convert buffer inputs 2,3 to 16 bit elevation error */ 
V_error = (int)irtput_buffer [33 ; 

V_error = (V_error & Oxff) « 8; 

V_err or += (int)input_buffer[23 & Oxff; 

/* convert buffer inputs 4,5 to 16 bit azimuth error */ 

U_error = (int)input_buffer[53 ; 

U_error = (U_error & Oxff) << 8; 

U_error += (Tnt)input_buf fer [4] & Oxff; 

f* Convert buffer inputs 6,7 to 16 bit total_strength error */ 


/* Adress of port A on 8255 */ 
/* Adress of port B on 8255 */ 
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Total_signal_strength = ( i nt ) i nputjxjf fer [7] ; 

Total_signal_strength = (Total_signal strength & Oxff) << 8; 
Total_signal_strength += ( int) input Jxjf fer [6] & Oxff; 

/♦Change integer value to a floating point value for normal i zing*/ 
Ch_ptr->Signal_strength = (double)Total_signal_strength - Offset; 

if (Ch_ptr->SignaL_strength < 0.00006) 

C 

/* Set signal_strength to small number if equal 0.0 */ 
Ch_ptr->Signal_strength = 0.000006; 


/* Normalize azimuth error */ 

Ch_ptr->U_error = (double)U_error / Ch_pt r->Signa ^strength ; 
/* Normalize Elevation error */ 

Ch_ptr->V_error = (double)V_error / Ch_ptr->$ignal_strength; 
> /* End of read channel data */ 


/* Ini t_Com_port initializes serial ports */ 

void Ini t_Com_port( void) 

< 

int rv = 0; 

/* Initalize RS-232 port Com2 will be for sending data a monitoring 
PC and Com3 will be ty\he receiver for DSP Data*/ 

/* rv = 2 bad 'com 1 parameter, rv = 3 no uart chip detected */ 

/ rv - 4 receive queue allocation error, rv = 4 transmit queue allocation 

/* the following line will be used for the compuadd computer at IlSkbaud *> 
rv = ComOpen(COM3, B1 15200, W8|S1|N0NE, 16, 16); 

/* Used for 19.2Kb option */ 

rv = ComOpen(COM2, B19200, W8|S1|N0NE, 16, 16); 

/* Set up COM2 port to be active */ 

ComAct i ve(C0M2); 

/* Remove all data from the receive buffer */ 

ComFlushRxO; 

/* Remove all data from the transmit buffer */ 

ComF lushTx( ); 

/* Set up COM3 port to be active */ 

ComAc t i ve ( COM3 ) ; 

/* Remove all data from the receive buffer */ 

ComFlushRxO; 

/* Remove all data from the transmit buffer */ 

ComFlushTxC ); 

> /* End of Ini t_Com_port */ 


/* Function Test_Serial_Link is used to test serial link from DSP 
to PC */ 

int Test_Serial J_ink(int Chan_Number, int Port_CJ)ata) 

int Stop_$erial_Data [3] = <0xBF,0x7F,0xEF>; 

int Initiate_Serial_Tran[3] = {0x40,0x80, 0x10}; 

int Data_Link_Length = 0; 

int Serial_Link_Error = 0; 

int Time_out = 0; 

int long test_loop; 

int delay_loop; 

int Error_number; /* Initialize Error number to be sent to 

calling program */ 


error */ 
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Time out = 0; L ^ * y 

Error_number = 0; /Mntialize error nunber to zero / 

Port_C Data = Port_C_Data | Ini tiate_$erial JT ran [Chanji umber - 1]; 

outp(Port_C_Address, Port_C_Data); 

for (testjoop = 1; testjoop <= 50; testjoop**) 


Time-out = 0; 

/* Check to see if data is available from the receiver electronics */ 
while (ComLenRxO < BLK_SZ) 

Data_Link_Length = ComLenRxO; 

Serial _Link_Error = ComErrorO; 

if (Serial Jink_Error != 0) 

/* Display date and time of error*/ 

printf ("\nRS232 link error detected Xx\n M ,SerialJink_Error); 
printf ("RS232 message length Xi \n". Data J ink Jength); 

Error_number =1; 

break; 

> 

Time_out +*; /* Increment timeout count for serial port */ 

if (Time_out == 32000) 

printf (“\nSerial link timeout error\n "); 

Error_number = 2; 

break; 

> 

> /* End of while (ComLenRxO < BLK_SZ) */ 

Data Jink Jength = ComLenRxO; 

/* If data length is greater than report error */ 

if (Data Jink Jength == 8) Read_Channel_Data<&Test [Chanjiumber - D); 
else 

^printf ("\r*lessage length error. Length of messege = Xi\n", Data Jink Jength); 
ComFlushRxO; 

> 

if (Error_number != 0) break; /* Exit for loop if failure has occurred */ 

for (delayjoop = 1; delayjoop <= 5000; delayjoop**); 

ComFlushRxO; 

> /* End of for test loop */ 

/* Turn off sync pulse to x channel */ 

Port J Jets = PortJJata & Stopjerial J)ata[Chan_Number - 1); 
outp(Port_C_Address,Port_C_Data); 

return Error_number; 

void Report JomJrror(int Error_onJ ink, int Channel) 

< 

int Datajength; 

/* Display date and time of error*/ 

Datajength = ComLenRxO; 

_strt ime( tmpbuf); 

”strdate( tmpbuf 1); „ 

fprintf (output_ptr, "\n Time & Date of error = Xs *s , 
tmpbuf , tmpbuf 1); 

f pr i nt f ( output_pt r , n \nRS232 link error detected Xx on Channel Xi \n", 
Error_onJ ink, Channel); 

fprintf (output_ptr, M RS232 message length Xi \n'», Data Jength ); 

> 
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/* Function Serial_Port_Timeout reports timeout failure of serial port */ 

void Serial_Port TimeoutCint Channel) 

C 

printf ("\nSerial Port timeout has occurred on Channel Xi", Channel); 

_strtime( tmpbuf ); /* Retreive system time and date */ 

_strdate( tmpbuf 1); 

printf ("\n Time of timeout = Xs", tmpbuf); 
fprintf (output_ptr, "\n Time & Date of error = Xs Xs ", 
tmpbuf , tmpbuf 1); 

f printf (output_ptr,"\nSerial Port timeout has occurred on channel Xi ", Channel); 


void Initial ize_Dsp_Link(void) 
t 

int Stop_Data[3] = <0xBF,0x7F,0xEF>; 

int Ini tiate_Serial [3] = (0x40,0x80,0x10); 

long int longjdelay; 

int Ini t_Chan; 

int Port”data = (0x00); 

for (Ini t_Chan = 1; Init_Chan <= 3; Ini t Chan++) 

( 

/* Turn on sync pulse to DSP */ 

Port_data = Port_data | Ini tiate_Serial [Ini t_Chan] ; 
outp(Port_C_Address,Port_data); 

for ( l ong_de l ay = 1; long_delay <= 500000; long_delay++); 

/* Turn off sync pulse to x channel */ 

Port_data = Port_data & Stop_Data [Ini t Chan); 
outp( Port_C_Address , Port data); 


> /* End of function Ini t ial i ze_Dsp_Link */ 
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/* Track. C: Main executive for controlling the tracking software */ 


^include <stdio.h> 

#include <conio.h> 

#include <ctype.h> 

#include <time.h> 

#include <dos.h> 

#include <time.h> 

#include <cport.h> 

#include <math.h> 

#include <stdlib.h> 

#include <graph.h> 

vo i d Move_Chan_T o_S t a r t i ng_Pos (void); 
void I n i t _Ch anne l _Addres s ( vo i d ) ; 
void Compute_Offset( int I_chan); 
void Ini t_Array(void); 

extern void fortran POSITION int far ‘ICHANNELjnod, int long _far * INTRACK, 
double _far *U, double far *V, 
long int far *ISTEPA, long int _far MSTEPB); 


extern void fortran INIT(int long _far *REALTIME), 


extern unsigned Contro l_word_address; 
extern unsigned Control_word; 


/* Address to which 8255 conmand word 
is being set V 

/* Sets all ports A,B to inputs & 

C to outputs */ 


/* Declare the following variables external these var. are declared in motor. c*/ 
extern unsigned Motor Pairl Address; /‘Address to first pair of motor controllers 

extern unsigned MotorJ>air2 Address; /‘Address to first pair of motor contro ers 

extern unsigned Motor Pair3_Address; /‘Address to first pair of motor controllers 


*/ 

*/ 

*/ 


/* Declare all variables used for 8255 control */ 

extern unsigned Contro l_word_address; /* Address of Control word on 8255 / 

extern unsigned Port_A_Address; f* Address of port A on 8255 / 

extern unsigned Port_B Address; I* Address of port B on 8255 / 

extern unsigned Port C_Address; /* Address of port C on 8255 / 


extern int Reset_to_zero; /* These 2 variables will be used global for setting motor position */ 
extern int Set_to_actual; 


/* Array of data used to read in RS232 data back from the DSP */ 
extern struct Channel_data 
t 

unsigned Time_tag; 
double V_error; 
double U_error; 
double Signal_strength; 
signed char Transmi t_Data; 

} Channel [3] , Test [3] ; 


unsigned Channel_TimeJTag E4] ; 
i nt Aqui re_New_T i me_T ag [4] ; 

/* Declarations for channel bias offsets V 

double Uoffset[4] = <0. 0,0.0, -0.5, -0.446}; 

double Vof fset [4] - <0. 0,0.0, -0.2, -0.390>; 

double U Delta [6] = CO. 00, 1.0, -2.0, 1.0, 0.00, 0.00}; 

double V Delta [6] = C0.00, 0.00, 0.00, 1.0, -2.0, 0.00}; 

double HaxU Delta[6] = CO. 00, 1 .00, -1 .00, 0.00, 0.00, 0.00}; 

double MaxV_Delta [63 = Cl .00, 1 .00, 1 .00, 2. 00, 0.00, 0.00}; 

double Step_size = .05; 


int Sample_Counts = 100; 

int Sample”count [4] = CO, 0,0,0}; 

doubl^S^gnal Pwr[4] [6] ' = * CC0. 0,0. 0,0. 0,0. 0,0. 0,0.0}, CO. 0 0.0 0.0 Cf.O 0.0, 0.0}, 
0.0. 0.0. 0.0. 0.0. 0.0.0}. CO. 0,0. 0,0. 0,0. 0,0. 0,0.0}}; 


/* Threshold for determining intrack condition */ 
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double track_threshold[4] = {0. 5, 0.5, 0.5,0. 5}; 
double High_ threshold = 0.5; 
double Low_threshold = 0.1; 

long int Of fset_Posi tion [3] [4] ; 
unsigned int Channel_Address [4] ; 


extern FILE *output_ptr; /♦ Pointer for file to output error data ♦/ 

extern FILE *Data_Ptr; /* Pointer for file to output test data */ 

extern FILE *System_Ptr; /♦ Pointer for file to read and store system parameters */ 

extern FILE *AzEl_Ptr; 

extern FILE *Align_Ptr; 

extern FILE *Track_AzE lj>tr; 

extern FILE * Input J>tr; 


extern long int Starting Posi tion[2] [3] ; 
extern int Selected_Channels [33 [2] ; 


int PortJJata = 0x00; 
int Pwr_24Volts_On = 0x20; 
int Pwr_24Volts_0f f = 0x0 F; 


/♦Initialize variable for port c data reg. */ 
/♦Variable used to turn on 24 volt supply ♦/ 
/♦Variable used to turn off 24 volt supply */ 


int Track_Opt ion; /♦ Flag used to determine what tracking option to do */ 

long int In_track = 0; /♦ Flag passed to control software indicating intretk position */ 

long int Track_Flag [4] = {0,0, 0,0}; /♦ Array used to used to store intrack flag ♦/ 


double U_signal = 0.0; 

double V_signal = 0.0; 

long int I_stepA = 0; 

long int I_stepB = 0; 

long int Act_pos[33; 

long int Present_Posi tion [3] ; 


/♦ Passes U error to control software */ 

/♦ Passes V error to control software ♦/ 

/* Control software commanded position for arm */ 
/* Control software commanded position for drum */ 


int long Real_time =1; /* Flag used to indicate real_time mode */ 

long int Motor_Command[3] ; 

int BLKSZ = 8; /♦ Size of message from DSP in bytes */ 

int F i rst_t ime_F lag = 1; 

int Closed_Loop_Test =1; /♦ Set to zero for open loop testing ♦/ 

int f i rst_t ime_in_track [4] = {0, 0,0,0); 
int Out_of_track_count [4] = {0,0,0, 0}; 


int Loop_count = 1; 

int count, loop; 

int N umbe r_ of _ Samples = 0; 


extern int Channel_to_Run [4] ; 
extern int Number_of j:hannels_To_Run; 

int T rack_Channel = 1; 
int I_channel = 2; 
int Active_Channel; 


/♦ Array used to disable sync pulse generation ♦/ 
int D i sabl e_Sync_Pu l se [4] = {OxOO,OxBF,Ox7F,OxEF>; 

/♦ Array used enable sync pulse generation ♦/ 
int Enable_Sync_Pulse[4] = {0x00,0x40,0x80,0x10}; 

char tmpbuf [128] ; /* Char array for storing time data */ 

char tmpbuf 1 [128] ; /* Char array for storing time data ♦/ 

long int delay; 


void Compute_Open_Loop_Coomands(void); /* Set up function prototype */ 
void Uai t_for_key_Press<voi de- 
void Check_for_Key_Pressed(voi de- 
void Sync_Serial_LTnk(void); 

unsigned L inkier ror = {0}; 
unsigned Data_length = {0); 
unsigned Time_out_count = {0); 

int Record_Flag [4] = {0,0, 0,0}; /* Set recording data opti on to zero */ 

char key_buffer [803 ; 
int Align = 0; 
int mode =1; 
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void main () 

< 


f* Assign channel asignments to data array */ 

Channel CO] .Transmi t_Data=0; 

Channel [1] . Transmi t_Data=1 ; 

Channel [2] .Transmi t_Data=2; 

Screen_Prompt(>; 

_clearscreen( J5CLEARSCREEN ); 

Open_f i l es ( mode ) ; /* Open all required files mode = 1 Indicates track mode */ 

/* Output control word to 8255 */ 

Port_Data = 0x00; 

out p( Cont ro l_word_address , Cont ro t_word) ; 
outp(Port_C_Address,PortJ)ata); 

Ini t_Array( ); 

Select_Channels_to_Run( ); /* Request the user what channels to run */ 

Select_Azel_Changes(); /*Request user for new azimuth and elevation parameters*/ 

/* Close files so that Avtec software can read data */ 

fclose(Input_Ptr); 

fclose(Track_AzEl_Ptr); 

INIT(&Real_time); /* Initialize Avtec control software V 

Init Channel_Address( ); /* Address of motor controller assignment*/ 

/* Turn off 24 Volt power supply */ 

Port_Data = Port_Data & Pwr_24Volts_0f f ; 
outpTPor t_C_Address , Port _Data ) ; 

Initial ize_Control lers( ); /* Initialize controllers to a predefined parameters */ 

/* Turn on 24 Volt power supply */ 

Port_Data = Port_Data | Pwr_24Volts_On; 
outp(Port_C_Address,Port_Data); 

for (delay = 1; delay <= 70000; delay++); 

Check_Switch_Status(); 

Check_System_Power( ) ; 

for (loop = 1; loop <= Number_of _Channels_To_Run; loop +♦) 

track_threshold[loop] = High_threshold; 

I channel = Channel to RunCloop]; 

OffsetPositionCO] [T channel] = Starting_Posi tionCO] CI_channel -1] ; 

Offset_Posi tion[1] [Tchannel] = -Start ing_Posi t ion [1] [^channel - 1] ; 

> 

Hove Chan To_Starting_Pos( ); 


/* Initialize serial port for receiving data */ 

Ini t_Com_port( ); /* Initialize com port for receiving data*/ 

_clearscreen( _GCLEARSCREEN ); 

printf ("\n\n Tracking program is now running !!"); 

printf ("\n Press 'e* to exit program"); 

printf ("\n\n ** Channel Status ** "); 


for (loop = 1; loop <= Number_of _Channels_ToJtun; loop +♦) 
i 

Ichannel = Channel_to RunCloop]; 

Port_Data = Port_Data J Enable_SyncJ>ulse[I_channel] ; 
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outp(Port_C_Address,Port_Data); /* Send out command to initate sync pulses */ 

/* Sync host pc to receiver electronics */ 

Sync_Se r i a l _L i nk ( ) ; 

whi led ) 

< 

for (Track_Channel = 1; Track_Channel <= Number_of Channels To_Run; 
Track_Channel++) 

I_channel = Channel_to_Run[Track_Channel] ; 

/* If only one channels is running make sure that sync pulse goes 
high before continuing */ 

if (Number_of _Channe l s_T o_Run == 1) 

while (I_channel == Check_for_Active_Sync_Pulse()); 

/* Wait till sync pulse goes low */ 

while <I_channel != Check_for_Act i ve_Sync_Pulse( )); 

Act i ve_Channel = Check_for_Active_Sync_Pulse(); 

/* Check to see if data is available from the receiver electronics 
Sync pulse is still active*/ 

while ( (ComLenRxC ) < BLK_SZ) && 

(I_channel == Act i ve_Channel )) 

Link_error = ComErrorO; 

if (L inkier ror != 0) 

Report_Com_Error(Link_error, I_channel); 

Act i ve_Channel = Check_for_Act i ve_Sync_Pulse( ); 

> /* End of while (ComLenRxC) < BLK_SZ) V 

PortJ)ata = PortJ)ata | 0x01; 

outp7Port_C_Address,Port _Data); /* Send out command to initate sync pulses */ 

/* Read data from serial buffer and format data as required */ 
if (ComLenRxC) >= BLK_SZ) 

C Read_Channel_Data(&Channel [I_channel - 1]); 
if ?Aquire New_Time Tag [I_channel] == 1) 

C 

Channel_T ime_Tag [I_channel] = Channel [I_channel - 1] .Time_tag; 

Aquire New_Time Tag [I channel] = 0; 

> 

> 

else 

< 

Channel [I_channe l - 1] .Si gna ^strength = 1.0; 

ComFlushRxC ); 

> 


if (Channel [I_channel - 1].Time_tag == Channel_Time_Tag [^channel] ) 

{ /* Increment next time tag for next frame comparison V 

Channel_T ime_Tag [I_channel] ++; 

/* Test to see if errors are out of range */ 
if (((Channel [I_channe l - 1] .Signal_strength/204.7) >= track_threshold[I_channel] ) 
&& (fabsl (Channel [I_channel - 1] .V_error) < 1.0) && 

( fabs l (Channel [I_channel • 1] .U error) < 1.0)) 
i 


Track_Flag[I_channel] = 1; 

Samp l e_CountT I _channe l ] ♦+; 

if (Sample_Count [I_channel] > 5) 

Signal_Pwr [I_channel] [I nte recount [I_channel] ] = 

Channel [!_channel - 1] . Si gna ^strength + 
Signal_Pwr [I_channel] [Inter_Count [I_channel] ] ; 
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if (Sample_Count CI_channel] == Sample_Counts) 
C 

Compute_Of f set( I_channel ) ; 

Sample_Count [I_channel] = 0; 

> 


/* Convert normalized values into microradians */ 

/* Channel 1 & 2 have a sign reversal */ 
if ( I_channel == 3) 

U_s i gna l = (Channel [I_channel - 1] ,U_error ♦ Uof f set [^channel] ) 

* -0.0002718; 

V_s i gna l = (Channel [I channel - 1].V_error ♦ Voffset [I_channel] ) 

* 0.00024537 


> 

else 

* U_signal = (Channel Cl channel - 1].U_error + Uof fset [I_channelJ ) 

* 0.0002718; 

V_signal = (Channel [I channel - 1].V_error + Voffset [I_channet] ) 

* -0.0002453; 


> 


if (f irst_time_in_track[I_channel] == 1) 

C 

_settextposi t ion(Track_Channel + 7,2); 

/* printf ("\nChanne l %i in track mode”, I_channel ); V 
track thresholdCI ^channel] = Low_threshold; 

> 

Out_of_track_count [I_channel] = 0; 
first time_in_track[I_channel] = 0; 


> 

else 

< 

if (Out_of_track count [I_channel] > 5) 

< 

Track_Flag[I _channel] = 0; 

first_time in_track[I_channel] = 1; 

t r ac ^threshold [ I _channe 1 3 = High_threshold; 

/* Print out og track condition */ 
if (Out of_track_count 1 1 ..channel] == 6) 
i 

_settextposition(Track_Channel + 7,2); 

/* printf ("\nChannel %i out of track", I_channel );*/ 

> 

> 

Out_of_track_count [I_channel] ♦+; /* Increment out of track counter */ 

V_signal = 0; /* Set U and V errors to zero so motors will */ 

U signal = 0; /* not be command to move on bad data */ 


> 


In_track = Track_Flag[I_channeU; 

Read_Actual_Pos(Channe l ^Address C I _channe l ) , Ac t _pos ) ; 

I stepB = Offset_Posi tion[0] [l_charmel] - Act_pos[0]; 

I^stepA = Act_pos [1] - Offset_Posi t i on Cl] [I_channel] ; 

/* Call Avtec control software for new position commands V 
POS I T I ON ( &T rac k_Channe l , &In_track, &U_signal ,&V_signal ,&I_stepA,&I_stepB); 

/* Set up the commanded position for the DiskB Motor */ 

Motor_Command[0] = Offset ..Position [OH I _channe l ] - I_stepB; 

/* Set up the commanded position for the DiskA Motor */ 

Motor_Command[1] = Offset_Posi tionCl] U_channel] + I_stepA; 

Wri te_F i na l_pos(Channel_Address [I_channet] ,Motor_Command) ; 
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Wri te_to_f lag_registor (Channel-Address [I-Channel] ,0x0808); 

/* Output data to file if requested */ 
if (Record F lag [I-Channel] == 1) 

< 

fprintf (Data_Ptr \nX6u f %+8.3f, %+8.3f, %+8.3f, %+9li, %+9li, %+9li, %+9li, %+9li, %+9li“ 
Channel [I_channe l - 1].Time_tag, 

Channel [I_channe l - 1] .Signal strength/204. 7, 

V_s i gna l * 1000000,U-Signat *”l 000000, 

P resent_Pos i t i on [0] , Mot or_Command [0] , I_stepB, 

Present_Posi t ion(1] ,Motor_Conmand[1] , IstepA); 

Number_of_Samples ++; /* Record number of samples taken */ 

if (Number_of Samples >= 1201) 
l 

Record-Flag [I_channel] = 0; 

Number_of_Samples = 0; 
printf("\nMax samples taken !!'»); 

> 

> /* End of if record flag = 1 */ 

> /* End of if Channel .Time_tag == Time-Tag */ 
else 

Sync_Serial_Link(); 

break; 

> 

/* Send out command to toggle line that frame is done */ 

Port-Data = Port_Data & OxFE; 

outp(Port_C_Address, Port-Data); /* Send out command to initate sync pulses */ 

Check_f or_Key_Pressed( ) ; 

> /* End of for I -Channel =1 to 3 V 

> /* End of while = 1 */ 

) /* End of main function */ 


414 /* Function Ini t_Channel_Addressddress of motor controller assignment*/ 

415 void Init_Channel Address(void) 

416 C 

417 Channel_Address [1] = Motor_Pai r1_Address; 

418 Channel_Address [2] = Motor_Pai r 2-Address; 

419 Channel Address [3] = Motor Pair3 Address: 

420 > " 

421 

422 /* Close-Down function will shut down the system in a orderly fashion */ 

423 void Close down(void) 

424 < 

425 int Ch; 

426 

427 ComCloseAl l ( ); /* Close all serial ports */ 

428 

429 for (Ch = 1; Ch <= 3; Ch ++) 

430 { 

431 /* Disable sync pulse to all channels */ 

432 Port_Data = Port_Data & D i sable_Sync_Pulse [Ch] ; 

433 outp(Port C_Address,Port Data); 

434 > 

435 

436 /* Turn off 24 Volt power supply */ 

437 Port_Data = Port_Data & Pwr_24Vol ts_0f f ; 

438 outp(Port-C Address, Port Data); 

439 

440 /* Set all position registors to actual position to stop motors V 

441 for (Ch = 1; Ch <= 3; Ch++) 

442 Set-Motor-Posit ion( Channel Address [Ch] , Set to actual)- 

443 ’ " " 
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Write_system_data( ); 

f close (output_ptr); /* Close file when done */ 

f close (Data_Ptr); 

f close (System_Ptr); 

f close (AzE l_Ptr); 

fclose (Align_Ptr); 

fclose (Track_AzE l_Ptr); 

exit (0); 


/+ Function To_Start ing_Pos moves each channel to 

the required position for tracking mode operation V 

void Move_Chan_T o_S t a r t i ng_Pos( vo i d ) 

long int Ini tial_Pos[3] ; 
long int Target_Posi t ion[2] C4] ; 
long int Target [33; 
int At_Target = 0; 

int Delta Limit = 25; /* Delta between target and actual move to 

indicate the arm is at its designated 
position */ 


for (Track_Channel = 1; Track_Channel <= Number_of_Channels_To_Run; Track_Channel++) 

I_channel = Channel_to_Run[Track_Channel] ; 

V_signal = 0; 

U_signal = 0; 

/* call control software to get initial position to were arm should go */ 

POSIT ION (&Track_Channel , &In_track, &U_signel,&V_signal,&I_stepA,&I_stepB); 

/* Set up the commanded position for the Disk B Motor */ 

Motor Command [0] = Of fset_Posi t ionCO] CI_channel] ■ I_stepB; 

Target Posi ti on [0] [^channel) = Motor_Command[0] ; 

/* Set up the commanded position for the Disk A Motor V 
Motor_Command [1] = Of fset_Posi t i on [13 [l_channel] + I_stepA; 

Target_Position[1] [I_channel] = Motor_Command[1] ; 

j* grite out the new motor positions that we will need to move to V 
Wri te_Final jx>s(Channel_Address[I_channel] ,Motor_Comnand); 

/* start Trapizodial move */ 

Wri te_to_f lag_registor <Channel_Address[I_channel] ,0x0808); 


printf (“\nChanne Is being sent to their starting positions"); 


/* Wait for channels to reach their destinations */ , , 

for (Track Channel = 1; Track_ChanneL <= Number_of_Channels_To_Run; Track_Channel ) 

I_channel = Channel_to_Run[Track_Channel] ; 

Target [1] = Target_Posi t ion Cl HI .channel] ; 

TargetCO] = Target _Position[0] [l_channel] ; 

At_Target = 0; 

whi le (At_Target != 1) 

C 

At^Target” = e Reach^^ommanded_Pos(Channel_Address [I_channel] , Target , I_channel ,De It delimit); 

> 

> 


printf ("\nChannels have reached their starting positions* 1 ); 
> /* End of function Move_Channels_To_Start */ 
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/* Function Check_for_Key_Pressed (void) will be used check for an exit key */ 
void Check for Key_Pressed(void) 

C 

char Key_number; 

if (kbhitO) 

C 

Key_number = getch(); 
su i t ch ( Key_number ) 

case 'e'; CloseJ)own( ); 
default: break; 

> /* End of switch statement */ 

> /* End of if kbhitO */ 

> /* End of function Check_forJ(ey_Pressed */ 

void Sync_Serial Link(void) 

C 

/* Run through one cycle of sync pulses to synchronize commini cat ions */ 
for (Track_Channel = 1; Track Channel <= Number_of Channels To Run* 
Track_Channel++) “ “ “ 

I_channel = Channel_to_Run[Track_Channel] ; 
while (I_channel != Check_for_Act ive_Sync PulseO); 
while ( I_channel == Check_for_Active_Sync_Pulse()); 

Aqui re_New_T ime_Tag [I_channeU =1; 


> 


ComFlushRxO; 


> 


/* Flush out data before starting loop after synchronizing 
serial link */ 


void Compute_0f fset( int I chan) 

{ 

double Max_Sig; 
int Number_of_Max; 
int loop; 

Inter_Count [I _chan] ++; 

lf ( ( Inter_Count [I_chan] >= 0) && ( Inter_Count [I_chan] <= 4)) 

Uoffset [I_chanJ = Uof fset [I_chan] + U_Del ta [Inter_Count CI_chan]] ; 

Voffset [l_chan] = Vof fset [I_chan] + VJJel ta [Inter_Count [I_chan]] • 

else 

( 

Inter_Count [I_chan] = 0; 

Max_Sig = 0; 

/* Determine max power signal for x sanples */ 
for (loop = 0; loop <= 4; loop++) 

< 

if (Signal_Pwr [I_chan] [loop] > Max Sig) 

Max_S i g = Signal_Pwr [I_chan] [loop] ; 

Number_of_Max = loop; 

> 

> /* End of for loop 0 to 4 V 
if ( I_chan == 2) 

fprintf (Data_Ptr," \nX6u, X+8.3f, X+8.3f, X+8.3f, X+8.3f, X+8.3f ,X+8.3fX, ;i», 

Channel [I_chan - 1] .Time_tag, Signal_Pwrtl_chan]C0] , 
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Signal_Pwr [I_chan] [1] ,Signal_Pwr [I_chan] [2], 
Signal J>wr£l”chan] [3] , Signal_Pwr [I_chan] [43, 
Max_Sig, Number_of_Max); 


Uoffset [I_chan] = Uof f set [I_chan] ♦ MaxUJ)el ta [Number_of_Max] ; 
Voff set [I~chan] = Vof f set [I_chan] + MaxV_Del ta [Nunber_of_Max] ; 

/* Reinitalize signal strength array back to zero V 
for (loop = 0; loop <= 5; loop++) 

Signal_Pwr [I_chan] [loop] = 0; 

> /* End of Inter_Count [I_chan] == 5 V 

> /* End of function Compute_of fset */ 


void Ini t_Array(void) 

L 

int i; 

for (i = 0 ; i <=5 ; i ++ ) 
i 

U_Del ta[i] = U_Delta[i3 * Stepjnze; 

V Delta [i] = V DeltaCi] * Step_size; 

MaxU DeltaCi] =~MaxUJ)elta[i] * Step_size; 

HaxVJJeltaCi] = MaxV_Del ta [i] * Step_size; 

> 

> 

void Wait_for_key_Press(void) 

L 

printf ("\n Press any key to continue"); 

/* Display message until key is pressed. V 

while( IkbhitO); /* Wait for key on keyboard to be pressed */ 

/+ use getch to throw key away. */ 
while (kbhitO) getchO; 


> 
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1 

5.5 

• Predicted 

azimuth of LEO 1 

(deg) 

2 

3.0 

! Predicted 

elevation of LEO 

1 (deg) 

3 

-7.5 

! Predicted 

azimuth of LEO 2 

(deg) 

4 

4.0 

! Predicted 

elevation of LEO 

2 (deg) 

5 

8.0 

! Predicted 

azimuth of LEO 3 

(deg) 

6 

-3.5 

! Predicted 

elevation of LEO 

3 (deg) 
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1 

.02 

2 

3 

3 

40 

4 

0.5 

5 

.FALSE 

6 

42164. 

7 

0 . 

8 

0 . 

9 

0 . 

10 

0 . 

11 

0 . 

12 

3 

13 

6528. 

14 

0 . 

15 

30. 

16 

25. 

17 

20. 

18 

0 . 

19 

6878. 

20 

0 . 

21 

28. 

22 

345. 

23 

310. 

24 

0 . 

25 

6528. 

26 

0 . 

27 

30. 

28 

330. 

29 

0 . 

30 

0 . 


! Duration of simulation in hours (REAL*8) 
! Number of disc channels (INTEGER) 

! Tracking rate in Hz (INTEGER) 

! Tracking gain (REAL*8) 

! Write flag for detailed output (LOGICAL) 
! HEO orbital elements at time 0 (REAL*8) 


! Number of LEO satellites (INTEGER) 

! LEO #1 orbital elements at time 0 (REAL*8) 


! LEO #2 orbital elements at time 0 (REAL*8) 


* LEO #3 orbital elements at time 0 (REAL*8) 
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2 

3 

4 

5 

6 

7 

8 
9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 
21 
22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

32 

33 

34 

35 

36 

37 

38 

39 

40 

41 

42 

43 

44 

45 

46 

47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 
61 
62 

63 

64 

65 

66 

67 

68 

69 

70 

71 

72 

73 


. module/ ram/ boo t=0 adsys; 


{Module ad_conv will be used to for all A/D convertor related calls ) 

{Number of samples per frame) 

.external Points_per_f rame; 

{Counter used to track the number od data points taken) 

.external Data_Ready_to_be_Processed; 

{Counts number of convert pulses to A/D) 

.external Convert_pulse_count; 

{Send_convert will be used to generate the convert pulse to the A/D) 
.ENTRY send_convert; 
send_convert : ■ 

ENA Sec_Reg; {Select secondary registors) 

axl = dm( Point sj^er_Frame); 
ayl = dm(Convert_pulse_count); 

ar = axl - ayl; 

if eq jump $top_convert; {Test to see if enough points) 

{have been processes if so exit interrupt) 


PM( I4,M7) = axO; 
ar = ayl + 1; 

dm(Convert_pulse_count ) = ar; 
Stop_convert : 


{Write out to the program memory to) 
{initiate conversion of analog data) 
{A low pulse of 80+ Nsec, will be ) 
{present at the four channel A/D) 

{Increment the number of pulse counts 
in present frame) 


DIS Sec_Reg; {Switch registors back to primary mode) 

rti; 


{Ini t ial ize_AD initializes A/D with doing one read from the A/D) 
.ENTRY Ini tial ize_AD; 

Initiali ze_AD : 

ayO = PM( I 7,M7); 
rts; 

{Declare array that for storage of raw data from A/D All four channels 
will be stored in array. Assignment is as follows: 

Channel 1 will store in elements 1,5,9... 

Channel 2 will store in elements 2,6,10... 

Channel 3 will store in elements 3,7,11... 

Channel 4 will store in elements 4,8,12... 

) 
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services interrupt from A/D 
all four A/D channels} 


{Select secondary registers} 


74 (Read_data_int 

75 & reads data from 

76 .ENTRY Read_datajnt; 

77 

78 Read_data_int: 

79 

80 ENA Sec_Reg; 

81 

82 se = 4; 

83 

84 ar = PH(I7,H 7); 

85 sr = ASHIFT ar BY 4 (HI); 

86 sr = ASHIFT srl BY -4 (HI); 

87 

88 

89 ar = PM(I7,M7); 

90 DM(I6,M5) = srl, sr = ASHIFT ar (HI); 

91 sr = ASHIFT srl BY -4 (HI); 

92 

93 

94 ar = PM(I7,M7); 

95 DM(I6,M5) = srl, sr = ASHIFT ar (HI); 

96 sr = ASHIFT srl BY -4 (HI); 

97 

98 

99 

100 ar = PM(I7,M7); 

101 DM(I6,M5) = srl , sr - ASHIFT ar (HI); 

102 sr = ASHIFT srl BY -4 (HI); 

103 

104 

105 DM( I6,M5) = srl; 

106 

107 ayl = dm(Data_Ready_to_be_Processed); 

108 ar = ayl ♦ 1; 

109 dm(Data Ready_to_be_Processed) = ar; 

110 

111 DIS Sec_Reg; 

112 

113 rti ; 

114 

115 .endmod; 


(Set up se registor for muti function shifht inst} 

(Read 1st channel of data from A/D} 

(Shift data over to right} 

(to extend sign bit and rescale back} 

(to proper scale and store data into array} 

(Read 2nd channel of data from A/D} 

(Shift data over to right to extend sign} 

(bit and shift back left to rescale & store data 
for channel 1 in array} 

(Read 3rd channel of data from A/D} 

(Shift data over to right to extend sign} 

(bit and shift back to left to rescale & 
store data for channel 2 in array} 


(Read 4th channel of data from A/D} 

(Shift data over to right to extend sign} 

(bit and shiftback left to rescale & store data} 
(for channel 3 in array} 

(Store data for channel 4 in array} 

(Increment number of points read in} 


back to primary mode} 


(Switch registors 
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. module/ ram/ boo t=0 Algorthm; 


{Module algorithm will be used to compute the error signal for all four 
quadrants on the detector} 

{Total number of samples that will be stored at any one time} 

{number_of_samples = 40 used for eprom version 40 samples 
equals 10 samples of data per quadrant} 

-const nunber_of_f i l te resamples = 40; 

{number_of_samples = 20000 used for emulator version 200 samples 
equals 500 samples of data per quadrant} 

{.const number_of_f i l ter_samples * 2000;} 

{Declare array that for storage of the outputs from the bandpass filter 
will be stored in array. Assignment is as follows: 

Channel 1 will store in elements 1,5,9... 

Channel 2 will store in elements 2,6,10 

Channel 3 will store in elements 3,7,11... 

Channel 4 will store in elements 4,8,12... 

} 

{Array to store the output of the bandpass filter} 

.var/dm/ram/ci re Fi Iteredjdata [number_of_f i lter_samples] ; 

.global Fi ltered_data; 

{Array to store the output of the bandpass filter} 

.var/dm/ram/ci rc Lowpass_Fi lt_data [number_of_f i lter_samples] ; 

.global Lowpass_Fi lt_data; 


34 

{Pointer, length, and 

count increment of array for bandpass filter} 

35 

. var/dm/ram 

Fi l tered_data_add_ptr; 

36 

.var/dm/ram 

F i 1 1 e red_da t a_ l en_pt r ; 

37 

38 

.var/dm/ram 

Fi ltered_data_count_ptr; 

39 

. g l oba l 

Filter edda t a_add_pt r ; 

40 

41 

. g l oba l 

Fi l tered_data_len_ptr; 

42 

{Pointer, length, and 

count increment of array for Lowpass filter} 

43 

.var/dm/ram 

Low_F i l t_data_add_pt r ; 

44 

.var/dm/ram 

Low_ F i 1 1 jda t a_ l en_pt r ; 

45 

46 

.var/dm/ram 

low_Fi lt_data_count_ptr; 

47 

. g l oba l 

tow_Fi lt_data_add_ptr; 

48 

49 

. g l oba l 

Low_Fi l t_data_len _ptr; 

50 

51 

52 

.var/dm/ram 

Number_of_Data_Points_Processed; {Counter for tracking 

number of points processed} 

53 

54 

55 

. g l oba l 

Number_of_Data_Points_Processed; {Counter for tracking 

number of points processed} 

56 

57 

58 

{The following variables will be the final results from a frames worth of 
data } 

59 

.var/dm/ram 

Total_signal_strength; 

60 

.var/dm/ram 

Elevation_error; 

61 

62 

.var/dm/ram 

Azimuth_error; 

63 

. g l oba l 

Total_signal_strength; 

64 

. g l oba l 

Elevat i on_error; 

65 

66 

. g l oba l 

Azimuth_error; 

67 

.external 

Process_data_add_pt r ; 

68 

.external 

Process_data_len_ptr; 

69 

.external 

Bandpass_Fi It ; 

70 

71 

.external 

Lowpass_Fi It; 

72 

.external 

Delay_1; {Bandpass filter delays for channel 1} 

73 

.external 

Delay_2; {Bandpass filter delays for channel 2} 
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74 .external Delay_3; {Bandpass filter delays for channel 3} 

75 .external Delay 4; {Bandpass filter delays for channel 4) 


76 

77 

.external 

Pointer_1 ; 

78 

.external 

Pointer_2; 

79 

.external 

Pointer_3; 

80 

.external 

Pointer_4; 

81 

82 

.external 

Delay_1L; 

83 

.external 

Delay_2L; 

84 

.external 

Delay_3L; 

85 

.external 

Delay_4L; 

86 

87 

.external 

Pointer_1L; 

88 

.external 

Pointer_2L; 

89 

.external 

Pointer_3L; 

90 

.external 

Pointer_4L; 

91 

92 

93 

.ENTRY Fi lter_error_si gnal ; 

94 

95 

Filter error_signal : 

96 

97 

{Filter 

channel 1 thru bandpass} 

98 

99 


L5 = %Delay_1 ; 

100 

101 

102 


15 = DM(Pointer_1); 

103 

104 


MY1 = DM( 10, M0); 

105 

106 
107 


Call Bandpass__f i 1 1; 

108 

109 

110 


DM(Pointer_1 ) = 1 5; 

111 

112 

113 


DM(I2,M0) = HR 1 ; 

114 

115 

{Filter 

channel 2 thru bandpass} 

116 

117 


15 = DM(Pointer_2); 

118 

119 


MYl = DM(I0,M0); 

120 

121 

122 


Call Bandpass_f i It; 

123 

124 

125 


DM(Pointer_2) = 15; 

126 

127 

128 


DM(I2 # H0) = MR1; 

129 

130 

{Filter 

channel 3 thru bandpass} 

131 

132 


15 = DM(Pointer_3); 

133 

134 


MYl = DM(I0,M0); 

135 

136 

137 


Ca l l Bandpass_f lit; 

138 

139 

140 


DM(Pointer_3) = 15; 

141 

142 

143 


DM( I2,M0) = MR1 ; 

144 

145 

{Filter 

channel 4 thru bandpass} 

146 

147 


15 = DM(Poi nter_4); 


{Bandpass filter delays for channel 1} 
{Bandpass filter delays for channel 2} 
{Bandpass filter delays for channel 3> 
{Bandpass filter delays for channel 4> 

{Lowpass filter delays for channel 1} 
{Lowpass filter delays for channel 2} 
{Lowpass filter delays for channel 3> 
{Lowpass filter delays for channel 4} 

{Lowpass filter delays for channel 1} 
{Lowpass filter delays for channel 2> 
{Lowpass filter delays for channel 3> 
{Lowpass filter delays for channel 4) 


{Set up the length of the filter 
delay array for the FIR bandpass filter} 

{15 points to delay elements } 

{Send channel 1 data to input of 
Bandpass fitter} 

{Run data point from channel 1 
thru bandpass filter} 

{Store pointer of last sample to be 
saved} 

{Store output from filter} 


{15 points to delay elements } 

{Send channel 2 data to input of 
Bandpass filter} 

{Run data point from channel 2 
thru bandpass filter} 

{Store pointer of last sample to be 
saved} 

{Store output from filter} 


{15 points to delay elements } 

{Send channel 3 data to input of 
Bandpass filter} 

{Run data point from channel 3 
thru bandpass filter} 

{Store pointer of last sample to be 
saved} 

{Store output from filter} 


{15 points to delay elements } 
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177 

178 

179 
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193 

194 
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197 
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199 
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201 
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MY1 = DM( 10, HO); 

Call Bandpass_f i l t; 
DM(Pointer_4) = 15; 

DM(I2,M0) = MR1; 

{Change 12 and L5 for lowpass filter 
Modi fy(I2,M3); 

15 = %delay_lL; 


{Send channel 4 data to input of 
Bandpass filter) 

{Run data point from channel 4 
thru bandpass filter) 

{Store pointer of last sample to be 
saved) 


{Store output from filter) 
compututation) 

{Decrement the address pointer 12 
by the value of M3) 

{Set up length of FIR lowpass filter 
delay line) 


{Filter channel 1 thru lowpass filter) 
15 = DM(Pointer_1l); 
axO = DM(I2,M0); 
ar = abs axO; 
myl = ar; 

Call Lowpass_filt; 

DM(Pointer_lL) = 15; 

DM( I3,M0) = MR1 ; 

{Filter channel 2 thru lowpass) 

15 = DM(Pointer_2L); 
axO = DM( I2,MQ); 
ar = abs axO; 
myl = ar; 

Call Lowpass_f i 1 1; 

DM(Pointer_2l) = 15; 

DM(I3,M0> = MR1; 

{Filter channel 3 thru lowpass) 

15 = DM(Pointer_3L); 
axO = DM(I2,M0); 
ar = abs axO; 
myl = ar; 

Call Lowpass_f i It; 
DM(Pointer_3L) = 15 ; 

DM(I3,M0) = MR1; 


{15 points to delay elements ) 

{Send channel 1 data to input of) 
{Bandpass filter) 

{Rectify signal by taking the 
absolute value of axO) 

{Input parameter to lowpass filter) 

{Run data point from channel 1 
thru bandpass filter) 

{Store pointer of last sample to be 
saved) 

{Store output from filter) 


{15 points to delay elements ) 

{Send channel 2 data to input of 
Bandpass filter) 

{Rectify signal by taking the 
absolute value of axO) 

{Input parameter to lowpass filter) 

{Run data point from channel 2 
thru bandpass filter) 

{Store pointer of last sample to be 
saved) 

{Store output from filter) 


{15 points to delay elements ) 

{Send channel 3 data to input of 
Bandpass filter) 

{Rectify signal by taking the 
absolute value of axO) 

{Input parameter to lowpass filter) 

{Run data point from channel 3 
thru bandpass filter) 

{Store pointer of last sample to be 
saved) 

{Store output from filter) 
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{Filter channel 4 thru lowpass> 
15 = DM(Pointer_4L); 
axO = DM(I2,M0); 
ar = abs axO; 
myl = ar; 

Call Lowpass_f i It; 
DM(Pointer_4L) = 15; 
DM(13,M0) = MR1; 


{15 points to delay elements > 

{Send channel 4 data to input of 
Bandpass filter) 

{Rectify signal by taking the 
absolute value of axO) .... . 

{Input parameter to lowpass filters 

{Run data point from channel 4 
thru bandpass filter) 

{Store pointer of last sample to be 
saved) 

{Store output from filter) 


{Increment the mi*er of data points processed through algorithm} 


ay1 = dm(Number_of_Data_Points_Processed); 

ar ■ ayl + 1; 




rts; 

.ENTRY Compute_Tracking_Error; 


Compute_T r ack i ng_E r ror : 
Modify (i3,m3); 


axO = Dm(i3,m0) 
ayO * Dm(i3 # m0) 
axl = Dm(i3,m0) 
ayl = Dm(i3,m0) 


{Move address pointer back four places to pull 
out last computed values from frame} 


{Store qaudrant A data 
{Store qaudrant B data 
{Store qaudrant C data 
{Store qaudrant D data 


(channel 1) in axO) 
(channel 2) in ayO) 
(channel 3) in axl) 
(channel 4) in ayl) 


{Calculate total signal 
ar = axO ♦ ayO; 
a f = axl ♦ ayl; 

ar = ar + af; 


strengh) 

{Compute Quadrant 
{Compute Quadrant 


A + B magnitude) 
C + D magnitude) 


{Sum all Quadrants A + B + C + D) 


DM(Total_signal_strength) * ar; 


{Compute Azimuth error) 
ar = axO + ayO; 
ar = ar - af; 


{Conpute Quadrant A + B magnitude) 

{Subtract Quadrants A + B * C - D where 
af s C + D) 


DM(Azimuth_error) - ar; 


{Compute elevation) 

ar = axO ♦ ayl; <Add Quadrant A ♦ 0} 

af = axl ♦ ayO; fAdd Quadrant C ♦ B} 

ar = ar - af; {Subtract Quadrant (A + 0} - (C + B) } 

DM(Elevation_error) = ar; {Store Azimuth error} 

RTS; 

.ENDM00; 
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C 


* Analog Dev. ADSP-210x Filter Realization Copyright (C) by HYPERCEPTION, INC. 


* Filter Generated from File: kwband.FIR 

* 

* Filter 0rder=42 

* 

* Direct Form Realization of the following convolution sum: 


* 

* 

* 

* 

* 

* 

* 


N-1 

\ 

y(n) = / h(k)x(n-k) 

k=0 


* 

* 

* 

* 

* 


* 

* 

* 

* 

★ 


•1 -1 
z z 

o — > — o — > — o — > — o — > 
x(n) | j 

v h(0) v h ( 1 ) v h C 2) 


o — >- - + - - + --> - 


-1 

z 

•o — > 0 

I I 

v h(N-2) v h(N-1) 

I I 

+ - - > + --> o 

y(n) 



* 


> 

<* 

* The following main module example may be copied to a separate 

* filename (e.g. Main.dsp) and uncommented to provide a test of 

* the filter. A typical example of assembly and link commands 

* needed to produce executable filter test code would then be: 


dsppa Main <cr> 
dsppa kwband <cr> 

dsppl Main kwband -a archname. ACH -g <CR> 


* 

* 

*) 


NOTE: The Linker expects an Architecture Description File (.ACH) 
which is created by the System Builder. 


.MODULE /RAM/boot=0 FIR Fi It; (_ 015-Notation (scaling) is in effect > 

.CONST Length=42; < Length of impulse response > 

.VAR/PM/CIRC Delay 1 [Length]; 

.VAR/PM/CIRC Delay~2 [Length] ; 

.VAR/PM/CIRC Delay_3 [Length] ; 

.VAR/PM/CIRC Delay_4 [Length] ; 

.Global Delay_1; 

.Global Delay_2; 

.Global Delay_3; 

.Global Delay_4; 

.VAR/DM Pointer 1 [13; 

. VAR/DM Pointer~2[1]; 

.VAR/DM Pointer 3[1]; 

.VAR/DM Pointer_4 [1] ; 

.global Pointer_1; 

.global Pointer_2; 

.global Pointer_3; 

.global Pointer_4; 

.VAR/DM Coefficients [Length] ; 

.global Coefficients; 
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.VAR/PM Band_Coef f icients [Length] ; 

.global BaixfCoefficients; 

( Current circular buffer pointer > 


{ NOTE: The user may wish to store the following coefficients to an 
external .DAT file in hexadecimal format. Keep in mind that 
these source code coefficients have been quantized. > 


INIT Band Coefficients: 13,-78,-121,40,316,271,-293, 

-773,-305,889,1305,-17,-1780,-1598, 
806,2653,1350,-1874,- 3072 , - 532 , 2773 , 
2773,-532,- 3072 ,-1874,1350, 2653 , 806 , 
-1598,-1780,-17,1305,889,-305,-773, 
-293,271,316,40,-121,-78,13; 


INIT Delay _1 : 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0,0, 

0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 ; 


.INIT 


Delay_2: 


0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 
0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 ; 


0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 


INIT Delay_3: 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0,0, 
0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 ; 


INIT Delay_4: 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0,0, 
0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 ; 


.ENTRY Bandpass_Fi It; 

Bandpass_f i It: 

II = “Coefficients; 

CNTR = Length - 2; 

MR = 0, MX0 = DM( 1 1 ,M1 ) , 

( init mr mxO = coeff 


C Input is in MY1 register, } 
( output is in MR1 register. > 


i 16 points to filter coefficients } 


MY0 = PM(I5,M5>; 
myO = delay > 


DO convolve UNTIL CE; 

convolve: MR = MR + MX0*MY0 (ss) 

( mr = mr ♦ coeff*delay 

MR = MR ♦ MX0*MY0 (ss), 

PM(I5,M6) = MY1, 

C store sample in delay 


MXO = DM( 1 1 ,Ml ) , MY0 = PM(I5,M5); 
get next coeff get next delay > 

MXO = DM(I 1 ,M1 ); 

MR = MR ♦ MX0*MY 1 <SS); 
last multiply > 


MR = MR (rnd); 

Clf MV SAT MR;} (If an overflow condition has occured sat 
to reduce error} 


RTS; 

{Ini t_Bandpass_Coef f subroutine is used to move coefficients from 
program memeory to data memeory } 

.ENTRY Init_Bandpass_Coeff; 


Ini t_Bandpass Coeff: 

LI = 0; 

L5 = 0; 

Ml = 1; 

M5 = 1; 

II = ‘Coefficients; 

15 = 'Band_Coeff icients; 


(Set up pointer for data memeory) 
(Set up pointer for program memeory} 


CNTR = Length; 
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DO ini t_band_coef UNTIL CE; 
srl = PM(I5,M5); 

srO = px; (Store 8 data bits from px into 
sr = sr or Ishift srl by -8 (HI); 

ini t_band_coef : DM(I1,M1) = srO; 

RTS; 


C101 


srO> 


.ENDMOO; 
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* Analog Dev. ADSP-210x Filter Realization Copyright (C) by HYPERCEPT ION, INC. 


Fitter Generated from File: kwlow.FIR 
Filter Order=45 

Direct Form Realization of the following convolution sum: 
N-1 


y(n) = / h(k)x(n-k) 

k=0 


-1 -1 -1 
z z z 

o — > — o — > — o — > O > ■ " *0 >** 

x(n) | 


h CO) v h( 1 ) v h(2) v h(N-2) v h(N-1) 


y(n) 


.MOOULE /ram/boot = 0 LOW_FIR Flit; C Q15-Notation (scaling) is in effect > 
.CONST LengthJow=45; “ C Length of impulse response ) 

{Declare delay line arrays for lowpass filter) 


.VAR/PM/CIRC Delay_1L[Length_low] ; 
.VAR/PH/CIRC Delay_2L [Lengthjow] ; 
.VAR/PM/CIRC Delay_3L [Length_low3 ; 
.VAR/PM/CIRC Delay_4L [Length_low] ; 


.Global DelayJL; 

.Global Delay_2L; 

.Global Delay_3L; 

.Global Delay_4L; 

CDeclare pointers that will point to the delay line array elements) 

.VAR/DM Pointer_lL [1] ; 

.VAR/DM Pointer_2L [1] ; 

.VAR/DM Pointer_3L [1] ; 

.VAR/DM Pointer_4L C13 ; 


.global Pointer_1L; 

.global Pointer_2L; 

.global Pointer_3L; 

.global Pointer_4L; 

.VAR/DM Coefficients_low[Length_low] ; 
.Global Coeff icients_low,* 

.VAR/PM Low_Coeff [Length_low ] ; 

.Global Low_Coef f ; 


26,35,58,88,127,176,236, 

306,387,477,577,683,795,909, 

1023,1 134,1239, 1333,1416,1483,1532, 
1563,1573,1563,1532,1483,1416,1333, 
1239,1134,1023,909,795,683,577, 
477,387,306,236,176,127,88, 


. INI T 


Low Coeff: 
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.ENTRY 
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Lowpass 
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111 
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113 
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120 
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128 
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58,35,26; 

DelayjL: 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0. 0,0, 

0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 ; 

Detay_2L: 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0,0, 

0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 ; 

Delay_3L: 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0,0, 

0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 ; 

Delay_4L : 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0, 0,0,0, 

0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 , 0 ; 


{ Input is in MY1 register, ) 

{ output is in MR1 register. ) 


II = ‘Coeff icients_low; 
CNTR = Length_low - 2; 


i 16 points to filter coefficients > 


MR = 0, MX0 = DM( 1 1 ,M1 ) , MY0 = PM(I5,M5); 

C init mr mxO = coeff myO = delay > 


DO convolve UNTIL CE; 

convolve: MR = MR + MX0*MY0 <ss), MXO = DM(I1,M1), MYO = PM(I5,M5); 

t mr = mr + coef f*delay get next coeff get next delay > 


MR = MR + MX0*MY0 (ss), 
PM(I5,M6> = MY1, 

{ store sample in delay 

MR = MR (rnd); 


MXO = DM( 1 1 ,M1 ); 

MR = MR + MX0*MY1 (ss); 
last multiply > 


C If MV SAT MR;) {If an overflow condition has occured sat 
to reduce error) 

RTS; 

CInit_Lowpass_Coeff subroutine is used to move coefficients from 
program memeory to data memeory ) 

.ENTRY Ini t_Lowpass_Coef f ; 

{Set 11 and 15 to 0 indicating a non circular array) 


I n i t_L owpas s_C oe f f 
LI = 0 

L5 = 0 

Ml = 1 

M5 = 1 

II = ‘Coef f icients_low; 

15 = ‘Low_Coeff; 

CNTR = Length_low; 

DO ini t_low_coef UNTIL CE; 


<Set up pointer for data memeory) 
{Set up pointer for program memeory) 


srl = PM(I5,M5); 

srO = px; {Store 8 data bits from px into srO) 
sr = sr or Ishift srl by -8 (HI); 


init_low_coef : DM(I1,M1) = srO; 

RTS; 


.ENDMOD; 
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.module/ram/boot=0/abs=0 MAIN; 

{Module main will be used to initatize all system parameters > 
{and service alt interrupts} 


.include <c : \nase\dspcode\ez l ab\def 2 1 0 1 . h> ; < file has sys. cntl. registers > 

{Total number of samples that will be stored at any one time) 

{ Used for emulator version } 

{.const number_of_samples = 2000;} 


{ Used for Eprom version } 

.const number_of_samples = 400; 

{Declare array that for storage of raw data from A/D All four channels 
will be stored in array. Assignment is as follows: 

Channel 1 will store in elements 1,5,9... 

Channel 2 will store in elements 2,6,10... 

Channel 3 will store in elements 3,7,11... 

Channel 4 will store in elements 4,8,12... 

.var/dm/ram/ci re AD_Raw_Data{number_of_samples] ; 

{Pointer, length, and count increment of array that receives data from A/D} 
. va r/dm/ r am AD_rawdata_add_pt r ; 

.var/dm/ram AD_rawdata_len_ptr; 

.var/dm/ram AD jawdatajount jtr; 

{Points to the element in the array of raw data that is being processed} 
.var/dm/ram Process_data_add_ptr; 

. g i oba l Process_dat a_add_pt r ; 

.var/dm/ram Process_data_len_ptr; {Length of array} 

.global Process_data_Len_ptr; 

{Counter used to track the number od data points taken} 

. va r /dm/ ram Data_Ready_to_be_Processed; 

, g l oba l Data_Readyjo_be_Processed; 

{Maximum number of data points to be taken per frame} 

. var /dm/ ram Po i nt s_per_F r ame ; 

.global Points_per_Frame; 

{.init Points_per_Frame: lOOj} dumber of samples of data per frame} 


{Counts number of convert pulses to A/D} 

. var/dm/ram Conver t jxj l se jount ; 

.global Convert jxj lse_count; 


.var/dm/ram 

.var/dm/ram 

.var/dm/ram 

.var/dm/ram 


count_i rqO; 
Read_adc_add j>t r ; 
Conver t jxj l se_add_pt r ; 
Sync_f Lag_enable; 


{Time tag for data to be sent over to host computer} 
.var/dm/ram Frame_tag; 

.global Frame_tag; 

{.init Frame_tag: 000; } 


{Memory mapped I/O declarations} 
.port read_adc; 
.global read_adc; 


{Mapped I/O address that A/D is read} 


.port 
. g l oba l 


conver t jxj l se; {Mapped I/O address that initiates} 
convert jxj l se; {conversion on A/D} 


.po rt watch jiog; {Mapped I/O address to reset watchdog timer} 

.global watch_dog; 

.external Number of _DataJ>ointsJ>rocessed; {Counter for tracking 

number of points processed} 
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75 

.external 


Delay_1; 

{Bandpass filter delays for channel 1) 


76 

.external 


Delay_2; 

{Bandpass filter delays for channel 2) 


77 

.external 


Delay_3; 

{Bandpass filter delays for channel 3) 


78 

.external 


Delay_4; 

{Bandpass fitter delays for channel 4) 


79 






80 

.external 


Pointer_1; 

{Bandpass filter delays for channel 

1) 

81 

.external 


Pointer_2; 

{Bandpass filter delays for channel 

2) 

82 

.external 


Pointer_3; 

{Bandpass filter delays for channel 

3) 

83 

.external 


Pointer_4; 

{Bandpass filter delays for channel 

4) 

84 






85 

.external 


Delay_1L; 

{Lowpass filter delays for channel 1) 


86 

.external 


Delay_2L; 

{Lowpass fitter delays for channel 2) 


87 

.external 


Delay_3L; 

{Lowpass filter delays for channel 3) 


88 

.external 


Delay_4L; 

{Lowpass filter delays for channel 4) 


89 






90 

.external 


Pointer_lL; 

{Lowpass filter delays for channel 

1) 

91 

.external 


Pointer_2L; 

{Lowpass filter delays for channel 

2) 

92 

.external 


Pointer_3L; 

{Lowpass filter delays for channel 

3) 

93 

.external 


Pointer_4L; 

{Lowpass filter delays for channel 

4) 

94 






95 

.external 


F i l tered_data 

_add_ptr; 


96 

.external 


Fi ltered_data_len_ptr; 


97 

.external 


Fi ltered_data 

r 


98 






99 

.external 


Coefficients; 



100 






101 

.external 


Low_F i l t_data_add_ptr; 


102 

.external 


Low_F i l t_data 

_len_ptr; 


103 

.external 


Lowpass_Fi lt_ 

data; 


104 






105 

.external 


Coef f icients_ 

low; 


106 






107 

{Declarations of 

external subroutines in other modules) 


108 

.external 


Filter error signal; {Subroutine for filtering) 


109 




{error signal) 


110 

.external 


Initial! ze_AD; 

{Subroutine to initialize A/D) 


111 






112 

.external 


Send_convert; 

{Subroutine used to generate 


113 




convert pulse to A/D convertor) 

114 






115 

.external 


Read_Data_Int; 

{Subroutine reads in all 4 channels 

116 




of data from the A/D and sign 

extends 

117 




the data) 


118 






119 

.external 


Compute_T racking 

Error; {Subroutine to compute error signals) 

120 






121 

.externa l 


Transmit_data; 

{Subroutine used to transmitt data 

to 

122 




host computer) 


123 






124 

.external 


Sendjdata; 

{Subroutine used to service 


125 




sportO transmit interrupt) 


126 






127 

.external 


I nit Lowpass Coeff; {Subroutine used to 


128 




Initialize Lowpass coefficients) 


129 






130 

.external 


I nit Bandpass Coeff; {Subroutine used to 


131 




Initialize Bandpass coefficients) 

132 






133 

.external 


Set up uart_parameters; {Subroutine used to 


134 




Initialize uarts parameters) 


135 






136 

{Listed below is 

the interrupt jump table for the 2101) 


137 

{Resetting flag out disables the rs232 driver chip > 


138 






139 

jump 

start 

; nop; nop; nop; 

{ reset vector) 


140 

jump 

read_ 

data_int; nop; nop; nop; { irq2 interrupt vector) 


141 

jump 

Send_ 

data; nop; nop; nop; { sportO transmit vector) 


142 

rti; 

nop; 

nop; nop; 

{ sportO receive vector) 


143 

jump 

send_ 

convert; nop; nop; 

nop; { irql interrupt vector) 


144 






145 

set flag out; 

{ irqO interrupt vector) 


146 

cal l 

Reset 

Control Flags; 



147 

call Sync _pulse_di sable; 
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148 

rti; 



149 




150 

DM(Watchdog) = axO; 


{ timer interrupt vector) 

151 

C reset flag_out;) 


{ used for sync mode) 

152 

rti; 



153 

nop; 



154 

nop; 



155 




156 

Ccatl Reset_Control_F lags; rti; 

nop; nop;) {timer interuupt 

157 



used for non sync mode) 

158 

{End of the interrupt 

jump table) 

159 




160 

start: 



161 




162 

call Ini t_sys_par; 


{Initialize system parameters) 

163 




164 

call Ini t_Lowpass_Coef f ; 


{Initialize Lowpass coefficients) 

165 




166 

call InitJ5andpass_Coeff; 


{Initialize Bandpass coefficients) 

167 




168 

call Set_PrimaryJ)ata_Reg; 


{Initialize all data registors) 

169 




170 

call Set_up_uart __parameters 


{Initialize uarts parameters) 

171 




172 

call Ini t ial i ze_AD; 


{Initialize A/D for operation) 

173 




174 

call Reset_ControL_Flags; 


{Reset counters for number of samples 

175 



taken and processed) 

176 




177 

reset flag_out; 


{Disable serial port driver) 

178 




179 

axl = dm( Points Per Frame); 


{Set po i nt s_per_f rame and) 

180 

dm(Convert_Pulse Count )= axl; 

{Convert_pulse_count equal) 

181 




182 

axO = 1; 



183 

dm(Sync_f lagenable) = axO; 



184 




185 

ifc = 0x3 f; 


{Clear all interrupts before enabling ) 

186 

imask = 0x37; 


{Enable interrupts Irq2, 

187 



SportO Transmit, Irql, and IrqO for 

188 



sync mode, timer) 

189 




190 

{imask * 0x35 ;} 


{Enable interrupts Irq2, 

191 



SportO Transmit Irql, and Timer for 

192 



non sync mode) 

193 




194 

{Enable timer used for sync 

mode of 

operation it will be used to 

195 

reset the watchdog timer) 



196 




197 

ENA Timer; 


{Start timer for watchdog timer updates) 

198 




199 




200 




201 

main_loop: 



202 




203 

{ Wait for sync pulse to occur before 

continuing ) 

204 

axO = dm(Sync_f lag_enable); 



205 

ar = Pass axO; 



206 

if ne jump main_loop; 



207 

imask = 0x35; 

{Disable 

interrupt IRQO) 

208 




209 

Inner loop: 



210 

axl = dm(Data Ready to be Processed); 


211 

ayl = dm(Number of Data Points Processed); 

212 




213 

ar = axl - ayl; 



214 




215 

if eq jump Inner_loop; 

{Test \ 

and see if data needs to be processed 

216 


if not 

wait for next data to be input read from 

217 


A/D) 


218 




219 

call Fi lter_Error_Signal; 

{Call algorithm to filter error signal) 

220 




221 

axl = dm(Points_per_Frame); 




222 

223 

224 

225 

226 

227 

228 

229 

230 

231 

232 

233 

234 

235 

236 

237 

238 

239 

240 

241 

242 

243 

244 

245 

246 

247 

248 


ar = axl - ay f * 

” ne Jump Innerjoop; { 

Compute_T rack j ng Error . „ ’ e "° U9h P ° int * have ***> Processes 

' ' SJ’C"" 1 ”"”'"' 


249 

250 

251 

252 

253 

254 

255 

256 

257 

258 

259 

260 
261 
262 

263 

264 

265 

266 

267 

268 

269 

270 

271 

272 

273 

274 

275 


caU Transmi t__data 
DM(Watch_dog) = ax o ; 

°IS AR^SAT; 

fl y1 * cfcn(Frame_tag); 

ar = ayl + 
dm(Frame_tag) = ar; 

Wai t_for_enable: 

tf ! f n(s y n c_flag_enable); 
ar - Pass axO; 

' f ne Waii_for_enable; 

*fc = 0x02; 
imask = 0x37; 

ENA AR_SAT; 

jump main_loop; 


f Transmit data to 

a t0 Hos t computer} 


<-'U * Sol 4 ?, ““■> 


fEnable ^RoO}*^^ enablin 9 interrupt} 



disable irql: 
ayO =~0x3b; 
a *0 = imask; 
ar = axO AND ayO* 
imask = a p- 
rts; 




«et ay 0 f or bit to mask of irql) 


276 

277 

278 

279 

280 
281 
282 

283 

284 


~ — = — - 

a\/Tl _ «. . a r 

«et ayO for bit to mask of i rq 2} 


disable irq2: 
ayO =-0x1 f; 
axO = imask; 
ar = axO AND ayO 
imask = ar* 
rts; 



293 

294 

295 


™*** w "^ 
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355 

356 

357 

358 

359 

360 

361 

362 

363 

364 

365 

366 

367 

368 

369 


entry Reset .Control J lags; 

Rese t.Control.Fla 9 s: 

ar = to be Processed) = 

, ' a> ■ sr: 


< 2 1 ^"I ! l ™""~“ 

Reset.Timer: 6 m ^iisec.> 

axO = 7499; _ <Set up timer to timeou 

dm(Tcount_Reg) - < transmission) 

nop; {Enable RS232 drive 

Set Flag.out; 
rts; 





lnit_sys_par: 


axO = 0x1819; _ 

dm(Sys_Crtl_Reg) - axO, 


a x0 = 0x3200; 
dm(Dm_Wait_Reg) = axO; 


{ Set up timer parameters) 

axO - 9; 

{axO =39;) 

dm(Tscale_Reg) = axO; 

axO = 30719; 
dm(Tperiod_Reg) = axO, 


axO = 1 0000 ; 


{Sport 0 ^ e eoot^aK 0.) 

{conf:gasFlFO,lqO 

JK St states !or program memory) 


{Set Data memory wait st ®*®* T Q 3 ^ 4 = 0 ) 

{0WAIT2 - 0UAIT1 = 3 for ) 

{data from A/D DWAU watchd og) 

{generating output pulse 
{ timer ) 

•11 used for 40 hz. update) 

5“- - w < r> « » T 

cyc, * > 

{ for the frame timer) 

{Delay the first interrupt by approx. 

8.3 mi lli seconds> 


dn(Tcount.Reg) = a* 0 ** 

{lntialize Sportl control register) 

axO = 0x4000; _ {Internal clock of Sportl enab 

dm(Sport1_Ctrl_Reg) - axO. 


dm( Sportl ^_Sc l kd i v ) = axO; 

{lntialize SportO control register) 
axO = 0; 


{Set up timing for Sportl serial clock) 


8X0 = ° : n. {Disable Sport 0 Multichannel cabibility) 

rknf SPORTO RX WORD Si ) = axO; (Disable P“ 

S s s S!o:«x;«.oso) ■ «j; 

dm(SPORTO_TX_UORDSl ) - axO, 
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370 

dm(SPORTO TX VORDSO) = axO; 



371 




372 

axO = 0x4 e09; 



373 

dm(SPORTO CTRL REG) = axO; 

{Internal serial clock generation 


374 


Transmit frame sync and sync width 


375 


Internal transmit frame sync enabled 


376 


Data format right justifyed zero filled 


377 


unsed MSB's Serial length word = 10 


378 


SLEN + 1} 


379 




380 

(axO = 3 1 9; > 

{Set up transmission for 19.2k baud } 


381 




382 

axO = 52; 

{Set up clock for 115.9k baud data 


383 


transmi ssion} 


384 

dm(SPORTO SCLKDIV) = axO; 



385 




386 

axO = 0; 

{No receive frame sync divide} 


387 

dm(SPORTO RFSDIV) = axO; 



388 

dm(SPORTO AUTOBUF CTRL) = axO; 

{Autobuffer enabled} 

— 

389 




390 




391 




392 

{Set up mi sc. control registors} 



393 




394 

imask = 0x00; 

{ All interrupts Disabled } 


395 

icntl = 0x7; 

{ irqO, irql, irq2 are edge sensitive } 


396 

ifc = 0x3 F; 

{ Initialize by clearing all interrupts} 


397 



— 

398 

axO = 0; 

{Initalize frame tag counter } 


399 

dm( Frame tag) = axO; 



400 




401 

axO = 100; 

{Initialize frame markers} 


402 

dm(Points_per_Frame) = axO; 



403 




404 

axO = 1; 



405 

dm($ync flag enable) = axO; 

{Enable sync_f lag_enable flag} 


406 



— 

407 

ENA AR SAT; 

{Saturate the AR registor if a 


408 


overflow condition occurs} 


409 




410 

rts; 



411 




412 

.................. 

1( ..... r ...... .. .. , „ f '•tuttuittttiuuutitJtjjirriiijnsiniirtiirtitiiiirL 


H JJ 

V ^ Irff ff # ff rf ### 



414 




415 

{Set input array ptr sets up the pointers for all arrays required for this program} 

— 

416 




417 

Set primary data reg: 



418 




419 

10 = ‘AD Raw Data; 

{Set up address pointer for 


420 


processsing AD_Raw_data array} 


421 




422 




423 

DMCProcess data add ptr) = 10; 

{Store address pointer for pointing 


424 


to data in the array that will be 

— 

425 


processed} 


426 




427 

LO = %AD Raw Data; 

{Set length of buffer for a 


428 


circular array} 


429 




430 

DM( Process data len_ptr) = LO; 

{Store length of buffer data to be 


431 


to be processed} 


432 




433 

11 = ‘Coefficients; {Initialize 

11 for address of bandpass filter 11 

— 

434 

will for both lowpass and bandpass filters} 


435 




436 

LI = 0; {Set L6 equal 0 to indicate that the array is not 


437 

circuliar} 



438 




439 




440 




441 

12 = ‘Fi l tered data; 

{Set up address pointer for array 


442 


of outputs from bandpass filter} 


443 









CSore address pointer) 


444 

445 

446 

447 

448 

449 

450 

451 

452 

453 

454 

455 

456 

457 

458 

459 

460 

461 

462 

463 

464 

465 

466 

467 

468 

469 

470 

471 

472 

473 

474 

475 

476 

477 

478 

479 

480 

481 

482 

483 

484 

485 

486 

487 

488 

489 

490 

491 

492 

493 

494 

495 

496 

497 

498 

499 

500 

501 

502 

503 

504 

505 

506 

507 

508 

509 

510 

511 

512 

513 

514 

515 

516 

517 


DMCFi ltered_data_add_ptr ) = 12; 


L2 = %Fi ltered_data; 

DM(Fi ltered_data_len_ptr) = L2; 


{Set length of buffer for a > 
{circular array) 

{Store length of output filter) 
{buffer for bandpass filter) 


13 = "Lowpass_Fi lt_data; {Set up address pointer for array 

of outputs from bandpass filter) 

DM<Low_Fi lt_data_add_ptr) = 13; {Store address pointer for pointing 

to data in the array that will be processed) 


L3 = XLowpass_Fi lt_data; {Set length of buffer for lowpass 

filter array) 

DM(Low_F i l t_data_len_ptr) = L3; {Store length of output filter) 

{buffer for lowpass filter) 


{Set up adddress pointer for generating convert pulse) 
14 = “ConvertPulse; 

DM(Convert_Pulse_Add_ptr) = 14; 


{Set up address of delay line of bandpass filter and store address 
there is 1 delay line for each quadrant) 

15 = ‘Delay_1; 

DM(Pointer_1 ) = 15; 

15 = ~Delay_2; 

DM(Pointer_2) = 15; 

15 = *Delay_3; 

DM(Pointer_3) = 15; 

15 = "Delay_4; 

DM(Pointer_4) = 15; 

{Set up address of delay line of lowpass filter and store address 
there is 1 delay line for each quadrant) 


15 = "Delay It; 
DM(PointerJi) = 15 

15 = "Delay_2L; 
DM(Pointer_2L) = 15 

15 = ‘Delay_3L; 
DM(Pointer_3L) = 15 


15 = *Delay_4L; 

DM(Pointer_4L) = 1 5; 

15 = *Delay_1; {Reset address of 15 to initial delay element that 
processed) 


L5 = %Delay_1; 


{L5 will be used as the delay element length for both 
bandpass and lowpass filter) 


16 = *AD_Raw_Data; 


{Set up address pointer for array 
AD Raw data) 
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518 

519 

520 

521 

522 

523 

524 

525 

526 

527 
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532 
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545 
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548 
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559 
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562 
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565 

566 

567 

568 
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570 

571 

572 

573 

574 

575 

576 

577 

578 

579 
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581 

582 

583 

584 

585 

586 

587 

588 

589 

590 

591 


DM(AD_rawdata_add_ptr) = 16; 


(Store address pointer for input array) 


L6 = %AD_Raw_Data; 
DM(AD_rawdata_len_ptr) = L6; 


(Set length of buffer for a 
circular array) 

(Store length on input array) 


17 = 'Read_Adc; 

DM ( R ead_Adc_Add_P t r ) = 17; 


(Set up adddress pointer for reading A/D) 
( Store address ) 


M0 = 1; 

(Set up address counter for incrementing through the 
Raw_data_array, and intermediate arrays after the 
bandpass and lowpass filter) 

Ml = 1; 

(Set address counter to be used for bandpass & lowpass 
filters) 

M3 = -4; 

(Set up address counter to -4 to decrement address 
between bandpass and lowpass filtering) 

M5 = 1; 

(Set address counter to be used for bandpass & lowpass 
filters) 

M6 = 2; 

(Set up address counter to increment delay storage 
in bandpass and lowpass filter this provides the required 
offset in storing the data) 

M7 = 0; 

(Set up address counter to zero such that when 
reading the A/D and Sending the convert pulse that we 
don't change the address) 


(The following counters and array length indicators are spare and will 
be sent to zero) 


M2 = 0; 

M4 = 0; 

L4 = 0; 

L7 = 0; 

rts; 

.Entry Sync_pulse_enable; 

Sync_pulse_enable: 
axO = ij 

dm( Sync__f l ag_enabl e) = axO; (Set up flag for enabling IRQ0) 
rts; 

Sync_pu l se_d i sab l e : 
axO = 07 

cfrn(Sync_f lag_enable) = axO; (Set up flag for disabling IRQ0> 
rts; 


Check_sync_f lag: 

axO = dm(Sync_f lag_enable); 

ar = Pass axO; 

if eq jump Disable IrqO; 

ifc = 0x20; 

imask = 0x37; 

rts; 

D i sable_I rqO: 
imask = 0x35; 
rts; 

.endmod; 


(Clear irqO before enabling interrupt) 
(Enable IRO0) 


(Disable IRQO) 
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.module/ram/boot=0 uart; 

wM mmm mmmmmmmmmmmmm mmmmmmmmmmmmm y 

.const buffer_ length = 8; 

{Output Buffer will be used to store the formatted Dat8 words} 

. var/dm/ram/ci rc Out put_Buf fer [buff er_ length] ; 

. var/dm/ ram Number_of _words_sent ; 

. var/cfrn/ram Words_to_be_transmi tted; 


{Set up tenporary buffers for storing I0,M0,L0) 
.var/dm/ ram Temp_10_buffer; 

.var/dm/ram Temp_L0_buf fer; 

.var/dm/ ram Temp_M0_buf f er; 


.external 

.external 

.external 

.external 


Total_signal_strength; 

Elevation_error; 

Azimuth_error; 

Frame_tag; 


{Declare external subroutines used} 

.external Reset_Control_F lags; 

.external Sync_Pulse_Enable; 


{Subroutine used to reset 
control flags} 

{Sets flag for enabling 
IRQ0 interupt } 


{Marco delay loop used to generate a delay .8 uSec per count} 


.MACRO DELAY(%0); 

.LOCAL Delay_loop; 
cntr * %0; 

DO delay_loop until ce; 
nop; nop; nop; nop; nop; 
nop; nop; nop; nop; 
delay^loop: nop; 

.ENDMACRO; 

{Transmi t_data will be used to transmit data to the host computer* 
.ENTRY T ransmi t_data; 


Transmit data: 


ar = 0; 

dto(Number_of_words_sent) = ar; 
Call Set_address_pointers; 
{Call Set_up_test_data ; } 

Call Format_data; 

10 = 'Output_buf fer; 


{Reset counter to zero} 


{Set up address pointers} 

{Subroutine used for testing purposes 
sets up predefined data for transmission} 

{Format data into 8 bit words} 


ar = DM( I0,M0); {Transmit first word to host PC} 

TX0 = ar; 


ayl = dm( Number_of _words_sent ) ; 
ar = ayl + 1; 

dm(Nunber_of_words_sent) = ar; 


RTS; 

{Set address pointer store primary array address and length and 
temporary assigns new values to I0,L0,H0> 


Set_address_poi nters : 
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123 

124 
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c*n( T emp_ 1 0_ buffer) = 10; 
dm(Temp_LO_buf fer) = LO; 
dm(Temp_MOJxjffer) = MO; 

10 = ~Output_buffer; 

LO = %Output buffer; 

MO = 1 ; 


{Store 10, LO, and MO) 


{Set 10 to address of output buffer) 
{Set LO to length of output buffer) 


RTS; 


{Reset address pointer store primary array address and length and 
temporary assigns new values to I0,L0,H0 This subroutine is called 
when SportO has transmitted all 8 data words) 


Reset_address_po inter: 

10 = dm(Temp_I0_buf fer); {Primary data back to 10, L0, and M0) 

L0 = dm( T emp_L0_buf fer); 

M0 = (±n(Temp_M0_buf fer); 


Delay(IOOO); {Delay disabling driver by .8 msec.) 

reset flag_out; {Disable serial driver till next sync pulse) 

RTS; 


{Format_data is used to format the data to 8 bit words for data transmission) 
Format_data: 

axO = OxffOO; 
axl = OxOOff; 

ayO = DM(Frame_tag); 

call Bit_reversal; 

ar = axO and ayO; 

srl =0x001; 


{mask off 8 thru 1 and set bits to zero) 


sr = sr or Ishift ar by -7 (HI); {Shift data left 7 places 

Bits 16 thru 9 now become bits 
9 thru 2 and set bit 10 to one) 


DM( 10, M0) = srl; 


{Transmit data) 


ar = axl and ayO; {mask off 16 thru 9 and set bits to zero) 

srl =0x001; 

sr = sr or Ishift ar by 1 (HI); {Shift data right 1 place 

Bits 8 thru 1 now become bits 9 
thru 2 set bit 10 to one) 

DM(IO,M0) = srl; {Transmit data) 


ayO = DM(Elevat ion_error); 
call Bi t_reversal; 

ar = axO and ayO; {mask off 8 thru 1 and set bits to zero) 

srl =0x001; 

sr = sr or Ishift ar by -7 (HI); 


{Shift data left 7 places 
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148 

149 

150 

151 

DM( I 0,M0) = srl; 

152 

153 

154 

155 

ar = axl and ayO; 

156 

157 

srl = 0x001; 

158 

159 

sr = sr or Ishift 

160 

161 

162 

DH(I0,M0) = srl; 

163 

164 

165 

166 

ayO = 0M(Azimuth_« 

167 

168 

call Bit_reversal; 

169 

170 

ar = axO and ayO; 

171 

172 

srl = 0x001; 

173 

174 

sr = sr or Ishift 

175 

176 

177 

DM( 10, M0) = srl; 

178 

179 

180 

ar = axl and ayO; 

181 

182 

srl = 0x001; 

183 

184 

sr = sr or Ishift 

185 



186 

187 

188 

189 

190 

191 

192 

193 

194 

195 

196 

197 

198 

199 

200 
201 
202 

203 

204 

205 

206 

207 

208 

209 

210 
211 
212 

213 

214 

215 

216 

217 

218 

219 

220 
221 


Bits 16 thru 9 now become bits 
9 thru 2 and set bit 10 to one> 

{Transmit data} 

{mask off 16 thru 9 and set bits to zero} 


now become bits 9 thru 2} 
{Transmit data} 


DM(I0,M0) = srl; 


{mask off 8 thru 1 and set bits to zero} 

(HI); {Shift data left 7 places Bits 16 
now become bits 9 thru 2} 

{Transmit data} 

{mask off 16 thru 9 and set bits to zero} 

HI); {Shift data right 1 place Bits 8 1 
now become bits 9 thru 2} 

{Transmit data} 


ayO = DM(Total_signa ^strength); 
call Bit_reversal; 

ar = axO and ayO; {mask off 8 thru 1 and set bits to zero} 

srl - 0x001; 

sr = sr or Ishift ar by -7 (HI); {Shift data left 7 places Bits 16 thru 9 

now become bits 9 thru 2} 

DM(I0,H0) = srl; {Transmit data} 

ar = axl and ayO; 
srl = 0x001; 

sr = sr or Ishift ar by 1 (HI); {Shift data right 1 place Bits 8 thru 1 

now become bits 9 thru 2} 


{mask off 16 thru 9 and set bits to zero} 


DM(I0,M0) = srl; 
rts; 


{Transmit data} 


{Send data sends the next data word to the host PC after receiving 
a SportO transmit interrupt} 
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.ENTRY Send_data; 

Send_data: 

ENA Sec_reg; {Enable secondary registors} 

ayl = dm(Number_of_words_sent ); 
axl = dm<Words_to_be_transmi tted); 
ar = axl - ayl; 

if gt jump Transmit; 
call Reset_address_pointer; 

call Sync_Pulse_Enable; 

DIS Sec_reg; 
nop; 

RTI; 

Transmi t : 

ar = dm(I0 f M0); {Transmit next data word to host PC} 

txO = ar; 

ar = ayl + 1; {Increment counter of words that has been sent} 

dm(Number_of_words_sent)= ar; 

DIS Sec reg; {Disable secondary registor} 


{Test to see if all data has been} 

{sent} 

{If not done with data transmission 
jump to transmit else quit transmission } 

{If all data words have 
been sent reset control flags 
and exit interrupt routine} 


(Disable secondary registor} 


nop; 

RTI; 

{Set jjp_uart_parameters is used to initialize} 
.ENTRY Set_up__uart_parameters; 

Set_up_uart_parameters: 

ar = 0; 

dm(Number_of_words_sent ) = ar; 
ar = 8; 

dm(Words_to_be_transmi tted) = ar; 

RTS; 


{Set_up_test_data is a subroutine used to set up predi fined data} 
Set_up_test_data: 


ar = OxOleO; 

{dm< Frame_tag) = ar;} 

ar = 0x5556; 

DM(Elevation_error) = ar; 

ar = 0x5678; 

Dm(Azimuth_error) = ar; 

ar = Oxabc; 

Dm(Total_signal_strength) = ar; 


{Set up "T» for tranmission} 

{Transmit first word to host PC} 

{Set up "S" for tranmission} 

{Transmit first word to host PC} 

{Set up "T" for tranmission} 

{Transmit first word to host PC} 

{Set up M U" for tranmission} 

{Transmit first word to host PC} 


RTS; 

{Bit reversal routine will rotate bit order 1 to 16 to the order of 16 to 1} 
Bit reversal: 
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C 


MIOTJTI* 

roo.ino <r» «*« * " * " l “‘ 

prototype version 1.0 Ay.ee sy«t~. lee. »“*»• 1W2 
Inputs: 

AL s Arm angles (alpha) 

0 L = Disc angles (delta) 

ICHL = Channel index - 

SOL = Selected alpha & delta solution (1 or 2) 

INITDIR = Initialize disc direction flags 

ISTEPMAX = SiscTt epTt maximum rotation (DISCBU, 

WFLAG = Write flag (MISCBLK) 


Outputs: 


DLA(ICHL) 
DLB(ICHL) 
ISTEPAC ICHL) 
ISTEPBC ICHL) 
ALSTEP(ICHL) 
INITDIRC ICHL) 


= Disc driver A angle (delta A) 

= Disc driver B angle (delta B) 
s Disc A resolution step 

: Arm'ang l ^corresponding to ISTEPAdCHL) and ISTEPSdCHL) 
= initialize disc direction flag 


I NTEGER*4 I STEPNORP , JSTEPA, JSTEPB 
INTEGER*2 INITDIRC6). ISIGN0LD16) 

LOGICAL REVERSE 
INCLUDE •CIRCBLK.FCB' 

INCLUDE 'DISCBLK.FCB' 

INCLUDE 'MISCBLK. FCB' 

0ATA INIT /I/ 

.<*• PIStOEOtAX.GT.270) STOP ITS 

ALSET = ALSETDEG / RAD 
DISCSTEP = TWOPI / NSTEPS 
ISTEPNORP = NSTEPS - ISTEPHAX 
INIT =0 
END IF 

S-SX&. • «n / -™ 

JSTEPB = N1NT (DLBCONT/DISCSTEP) 


— ; 

C If disc direction is a „ 

or positive, maintain the same sign 


"l ready" initial! zed" and both old disc steps could be 


C negative 




I Ff INITDIRC ICHL) .EO.0 .AND. IABS(ISTEPAOLD(ICHL)).GE. ISTEPNORP 
1 !5BSOsiEPBOLD(ICHL)).GE.ISTEPNORP) THEN 

IF(1SIGN(1, JSTEPA). NE.ISIGNOLD(ICHL)) THEN 

JSTEPA = JSTEPA + IS1GN0LDCICHL)*NSTEPS 
JSTEPB = JSTEPB + IS1GN0LD(ICHL)*NSTEPS 


END IF 


END IF 
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C If either disc step exceeds maximum value, reverse both disc directions. 


I F( IABS( JSTEPA) .GT . ISTEPMAX .OR. IABS( JSTEPB). GT. ISTEPMAX) THEN 
REVERSE = .TRUE. 

JSTEPA = JSTEPA - I SIGNCNSTEPS, JSTEPA) 

JSTEPB = JSTEPB - I SIGN(NSTEPS, JSTEPB) 

END IF 

IF( I ABS( JSTEPA ).GT. ISTEPMAX. OR. I ABS( JSTEPB) .GT . I STEPMAX) STOP 116 

I F( INITDIRC I CHL ) . EQ.O .AND. REVERSE) THEN 
I F(WFLAG) WRITEC 15,20) 

20 F0RMAT(/17X, 'ROTATION LIMIT / DIRECTION REVERSED') 

WRI TE(20,21 ) TCUR, I CHL 

21 FORMAT(/ ' TIME =',F12.3,' SEC 1 ,8X, 'CHANNEL 12, 

1 * ROTATION LIMIT / DIRECTION REVERSED') 

END IF 

ISTEPAC ICHL) = JSTEPA 
I STEPBC I CHL ) = JSTEPB 



C Compute disc angles and arm angle. 




DLA(ICHL) = JSTEPA * DISCSTEP 
DLB(ICHL) = JSTEPB * DISCSTEP 

ALSTEP(ICHL) = ALSET ♦ DRATIO * (DLA(ICHL) - DLB(ICHL)) 

ISTEPAOLD(ICHL) = JSTEPA 
ISTEPBOLD(ICHL) = JSTEPB 
ISIGNOLD(ICHL) = I SI GN( 1 , JSTEPA) 

INITDIRC ICHL) = 0 

RETURN 

END 
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SUBROUTINE ANGLEPR ( A2S , ELS , AZAHEAD , E LAHEAD ,DLATRUE , 

1 ALTRUE , I LEO, ICHL, INTRACK,U,V) 

C In simulation mode, this routine computes and returns the 
C Angle Processor data. 

C 

C In real-time mode, this routine returns the Angle Processor data 
C previously saved. 

0 

C Prototype Version 1.0 Avtec Systems, Inc. August 1992 
C 

C Inputs: 

C 

C AZS 

c ELS 

C AZAHEAD 

C ELAHEAD 

C DLATRUE 

C ALTRUE 

C I LEO 

C ICHL 

C REALTIME 

C INTRACKSAVE 

C USAVE, VSAVE 

C 

C Outputs: 

C 

C INTRACK(ILEO) = In- track flag 

C U( I LEO) , V( I LEO) = Tracking detector errors 

C 




= Azimuths of LEO satellites from Scene Processor 
= Elevations of LEO satellites from Scene Processor 
= Azimuth point -ahead angles 
= Elevation point-ahead angles 
= True disc A angles (delta A) 

= True arm angles (alpha) 

= LEO satellite index 
= Channel index 
= Real-time flag (MISCBLK) 

= ln-track flag in real-time mode (SAVEBLK) 

= Tracking detector errors in real-time mode (SAVEBLK) 


IMPLICIT REAL*8 (A-H,0-Z> 

REAL*8 AZS ( 6), ELS(6 ), AZAHEAD (6) , ELAHEAD (6) 

REAL*8 DLATRUE(6) ,ALTRUE(6) ,U(6), V(6) 

LOGICAL INTRACK(6) 

INCLUDE 'CIRCBLK . FCB 1 
INCLUDE * FOVBLK. FCB 1 
INCLUDE 'MISCBLK. FCB‘ 

INCLUDE ‘SAVEBLK. FCB* 

DATA RMSERR /I. 60-5/ ! Tracking detector 2-axis rms error (rad) 

DATA RES /1.25D-6/ ! Resolution of u,v errors (rad) 

DATA TRMIS /ID-5/ ! Transmit/receive misalignment (rad) 

DATA INIT /V 


C In real-time mode, return the Angle Processor data previously saved. 




I F(REALTIME) THEN 

INTRACK(ILEO) = INTRACKSAVE 
U(ILEO) = USAVE 
V(ILEO) = VSAVE 
RETURN 
END IF 


C In simulation mode, compute and return the Angle Processor data. 




IF(INIT.EQ.I) THEN 

TANHALF = DTAN(5D- 1*FOVDEG/RAD ) 
HALFBEAMSQ = (5D- 1*BEAMW)**2 
SIGMA = RMSERR / DSQRT(2D0) 

CALL RNDM(UNIF) 

ORIENTMIS = TW0PI*UNI F 
TRMISHALF = 5D-1*TRMIS 
INIT = 0 
END IF 


FILE: D:\TEMP\ANGLEPR.FOR p age; c12 7 

Size: 6066 Edited: 8-12-92, 9:48p Printed: 11-17-92, 1:43p 


74 C 

75 C Determine coordinates of arm pivot point. 

76 C - 7: 

77 

78 XA = ARML * D COS ( HA LFP I -DLATRUEC ICHL ) ) 

79 YA = ARML * DSIN(HALFPI -DLATRUEC ICHL) ) 

80 

81 

82 C Determine coordinates of center of optics. 

83 - 

84 

85 COSAL = DCOSC ALTRUEC ICHL ) ) 

86 SINAL = DSIN(ALTRUE( ICHL)) 

87 

88 AZOPT = DATAN (TANHALF * (XA + C0SAL*YA - SINAL*XA)) 

89 ELOPT = DATAN (TANHALF * (YA - SI NAL*YA - COSAL*XA)) 

90 

91 

92 C Include transmi t/ receive misalignment. 

93 

94 

95 ANGLMIS = ORIENTMIS - DLATRUEC I CHL ) - ALTRUEC ICHL) 

96 COSMIS = DCOS(ANGLMIS) 

97 SINMIS = DSIN(ANGLMIS) 

98 

99 AZOPT T = AZOPT + COSMIS*TRMISHALF 

100 ELOPTT = ELOPT + SINMI S*TRMI$HALF 

101 

102 AZOPTR = AZOPT - COSMIS*TRMI SHALF 

103 ELOPTR = ELOPT - $INMIS*TRMI SHALF 

104 

105 

106 C Determine coordinates of LEO when HEO beam arrives. Note: errors in 

107 C point-ahead angles caused by small attitude and ephemeris errors are 

108 C negligible. 

109 

110 

111 AZLEO = AZS(ILEO) + AZAHEADC I LEO) 

112 ELLEO = ELS(ILEO) ♦ ELAHEADC I LEO) 

113 

114 

115 C Assume in track if LEO is within HEO beam. 

116 

117 

118 IF ( (AZLEO-AZOPTT )**2 + (ELLEO-ELOPTT)**2 .LT. HALFBEAM SO) THEN 

119 

120 I NTRACK( I LEO) = .TRUE. 

121 

122 

123 C Determine difference coordinates of center of received spot. 

124 

125 

126 AZDIF = AZS(ILEO) - AZOPTR 

127 ELD I F = ELS(ILEO) - ELOPTR 

128 

129 

130 C Determine rotation from azimuth, elevation to u v. 

131 I 

132 

133 ROT = - (HALFPI + DLATRUEC ICHL ) + ALTRUEC ICHL ) ) 

134 COSROT = DCOS(ROT) 

135 SINROT = DSIN(ROT) 

136 

137 

138 C Determine random u,v errors. 

139 

140 

HI UMEAN = AZDI F*COSROT + ELDI F*SINROT 

H2 VMEAN = -AZD I F*SINROT + ELDIF*COSROT 

143 

H4 UCONT = GAUSCL ( UMEAN , S I GMA , 3D0 ) 

145 VCONT = GAUSCL C VMEAN, SI GMA, 3D0) 

146 

147 


U(ILEO) = NINT(UCONT/RES) * RES 
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V(ILEO) = NINT (VCONT/RES) * RES 



C Assune not in track if LEO is outside HEO beam. 



ELSE 

INTRACK(ILEO) = .FALSE. 

END IF 
RETURN 
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DOUBLE PRECISION FUNCTION ARKTNS(N,X, Y) 

C FOUR QUAD ARC TANGENT X=COS(ANGLE) - Y=SIN(ANGLE) 
C N=180 GIVES PV BETWEEN -PI & +PI 

C N=360 GIVES PV BETWEEN 0 & +2PI 

IMPLICIT REAL*8 (A-H,0-2) 

P I =3 . 1 4 1 592653589793238D0 
TPI=2*PI 

IF (X.NE.0.0D0) GO TO 10 
IF (Y.GT.0.0D0) T=0.5D0*PI 
IF (Y.LT.0.0D0) T=1.5D0*PI 
IF (Y.EQ.0.0D0) T=0.0D0 
GO TO 20 
10 T=DATAN(Y/X) 

IF (X.LT.0.0D0) T=T+PI 
IF (T.LT.0.0D0) T=T+TPI 
20 IF (N.EQ.360) GO TO 30 
IF (T.GT.PI) T=T-TPI 
30 ARXTNS=T 
RETURN 
END 
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SUBROUTINE ASGNMFN (HEONAV,LEONAV,ECL IPSE ,AZS, ELS, I LEO, ICHL f 
1 LEOCHL, ICHLLEO, TCUR) 

The Assignment Function performs the following: 

Assigns disc channels to LEO satellites. 

Determines azimuth, elevation and point-ahead angles. 

Selects one of two possible solutions for the disc angle. 

Sets the scan reset flag for acquisition. 

Prototype Version 1.0 Avtec Systems, Inc. August 1992 

Entry points: 

ASGNMFN Assignment Function 

ASGNMFNR Read the predicted Az & El of LEO satellites and select 
alpha & delta solutions (in real-time mode) 

Inputs (ENTRY ASGNMFN): 

HEONAV = Geocentr ic- equator i al coordinates of HEO satellite from 
Navigation Processor 

LEONAV = Geocentric-equatorial coordinates of LEO satellites from 
Navigation Processor 

ECLIPSE = Eclipse flags from Scene Processor 

AZS = Azimuths of LEO satellites from Scene Processor 

ELS = Elevations of LEO satellites from Scene Processor 

I LEO = LEO satellite index 

ICHL = Channel index 

LEOCHL = LEO channel assignments 

ICHLLEO = Channel LEO assignments 

TCUR = Current time 

IRATE = Tracking rate (MISCBLK) 

REALTIME = Real-time flag (MISCBLK) 

WFLAG = Write flag (MISCBLK) 

Inputs (ENTRY ASGNMFNR): 

NLEOS = Number of LEO satellites 
NCHANNELS = Number of disc channels 
ICHLPRSEQ = Channel priority sequence 


IMPLICIT REAL*8 (A-H,0-Z> 

REAL*8 HE0S00N(6) ,LE0S00N(6,6) 

REAL*8 HE0NAVC6) , LEONAV(6, 6> , HE0NAVS00N(6) , LE0NAVS00N(6,6) 

REAL*8 AZS(6>,ELS(6),AZNAVT<6),ELNAVT<6) 

REAL*8 AZAHEAD(6),ELAHEAD<6) 

REAL*8 ALNAV(6,2),DLNAV(6,2) 

1NTEGER*2 LE0CHL<6), ICHLLEO(6) , ICHLPRSE<J(6), IALDLS0L<6>, 1N1TD1R(6) 
LOGICAL ECLIPSE(6),ECLPNAV(6),ECLPNAVSOON(6) # INTRACK(6),SCANRES(6) 
LOGICAL DONE 

CHARACTER M00E(6)*13,DASH(72)*1 
INCLUDE ‘CIRCBLK. FCB' 

INCLUDE 'D1SCBLK.FCB' 

INCLUDE ‘MISCBLK. FCB 1 

DATA MODE /6*'PARK'/ ! Channel modes 

DATA INTRACK /6*. FALSE./ ! In-track flags 

DATA INITDIR /6*1/ ! Initialize disc direction flags 

DATA DASH /72 

DATA INIT /I/ 

IF(INIT.EQ.I) THEN 

TSLEUMAX = 2*D I SCDEGMAX/D I SCVE L 
I F(UFLAG) URITE(14,20) DASH 
20 FORMAT (// 1 ASSIGNMENT FUNCTION'//' '.72A1) 

INIT = 0 
END IF 
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74 

75 

76 I F( I LEO.NE .0) THEN 

77 

78 C 

79 C 

80 C 

81 C 

82 C 

83 C 

84 C 

85 C 

86 

87 IF(LEOCHLOLEO).EQ.O) THEN 

88 

89 

90 

91 

92 

93 

94 

95 

96 

97 

98 

99 
100 
101 
102 

103 

104 

105 

106 

107 

108 

109 

110 
111 
112 

113 

114 

115 

116 

117 

118 C 

119 C 

120 C 

121 C 

122 C 

123 C 

124 C 

125 C 

126 C 


127 

128 


ELSE 

129 

130 


IF(. NOT. REALTIME) CALL XYZAZELCHEONAV, LEONAV, ILEO, 'N ' , 

131 

1 

' T ' , ECLPNAV, AZNAVT , ELNAVT , AZAHEAD , E LAHEAD ) 

132 

133 


IF(MODE(ICHL).NE. 'SLEW TO ACQ' .AND. ECLPNAVC I LEO) .AND 

134 

1 

.NOT . INTRACK( I LEO) ) THEN 

135 

136 


I F(WFLAG) WR I TE( 14,50) TCUR, ICHL, ILEO 

137 

50 

FORMAT (// 1 TIME =',F12.3,' SEC//8X, 'CHANNEL' , 12, 

138 

1 

* RELEASED FROM LEO', 12) 

139 


WRITE(20,55) TCUR, ICHL , I LEO 

140 

55 

FORMAT (/' TIME =',F12.3,' SEC ' ,8X, ' CHANNEL ' , I 2, 

141 

1 

* RELEASED FROM LEO', 12) 

142 

143 


LEOCHL(ILEO) = 0 

144 


ICHLLEOC ICHL) = 0 

145 


INITDIR(ICHL) = 1 

146 


MODE ( ICHL) = 'PARK' 

147 




IF(. NOT. REALTIME) THEN 
TSOON = TCUR + TSLEUMAX 
CALL OVAL (TSOON , I LEO , HEOSOON , LEOSOON ) 

CALL NAVI GPR2< HEOSOON , LEOSOON , I LEO, TSOON , HEONAVSOON , 

1 LEONAVSOON) 

CALL XYZAZEL( HEONAVSOON, LEONAVSOON, I LEO, *N' , 'T' , 

1 ECLPNAVSOON , AZNAVT , ELNAVT , AZAHEAD , ELAHEAD ) 

END IF 

I F( .NOT .ECLPNAVSOON ( I LEO) ) THEN 

LEOCHL(ILEO) = ICHL 
ICHLLEO(ICHL) = ILEO 
INI TO I R ( ICHL) = 1 
MOOE(ICHL) = ‘SLEW TO ACQ' 

SCANRESC I LEO) = .TRUE. 

I F(WFLAG) WRITE(14,40) TCUR, ICHL, ILEO 
40 FORMAT(//‘ TIME =',F12.3,' SEC' //8X, 'CHANNEL 1 , 12, 

1 1 ASSIGNED TO LE0\I2) 

WRI TE(20,45) TCUR , ICHL , ILEO 

45 FORMAT (/ ' TIME =',F12.3,' SEC ‘ ,8X, 'CHANNEL 12, 

1 ' ASSIGNED TO LEO', 12) 

IF(. NOT. REALTIME) CALL XYZAZEL(HEONAV,LEONAV, ILEO, *N ' , 

1 'T‘,ECLPNAV, AZNAVT, ELNAVT, AZAHEAD, ELAHEAD) 

END IF 


If (a) LEO is currently assigned a channel, and 

(b) Mode is not 'slew to acq', and 

(c) Eclipse flag from Navigation Processor data is true, and 

(d) In-track flag is false 

then (1) Release the channel, and 
(2) Set mode to 'park'. 


If (a) LEO is not currently assigned a channel, and 

(b) Eclipse soon flag from Navigation Processor data is false 

then (1) Assign the highest priority free channel, and 

(2) Set mode to 'slew to acq', and 

(3) Set scan reset flag to true. 
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END IF 
END IF 

If LEO is currently assigned a channel, convert from azimuth and elevation 
to alpha and delta and select solution 1 (in simulation mode). 


156 

157 IFCLEOCHL(ILEO).NE.O) THEN 

158 

159 IF(. NOT. REALTIME) THEN 

160 CALL AZELALDL( AZNAVT, ELNAVT, I LEO, I CHI, 12,ALNAV,DLNAV) 

161 I ALDLSOLC ICHL) = 1 

162 END IF 

163 

164 I F(WFLAG) THEN 

165 

166 ISOL = IALDLSOLUCHL) 

167 

168 

169 1 

170 2 

171 3 

172 60 

173 1 

174 2 

175 3 

176 4 

177 

178 END IF 

179 

180 END IF 

181 

182 END IF 

183 

184 C 

185 C Proceed to Control Function. 

186 C 

187 

188 CALL CNTRLFN(ECLPNAV,AZNAVT,ELNAVT, I ALDLSOL , AZAHEAD , ELAHEAD , 

189 1 ECL IPSE, MOOE,INITDIR, INTRACK, SCANRES, ICHL, I LEO, 

190 2 AZS,ELS, TCUR) 

191 

192 

193 RETURN 

194 

195 

196 C 

197 ENTRY ASGNMFNR(NLEOS,NCHANNEL$, ICKLPRSEO) 

198 

199 C Read the predicted Az & El of LEO satellites and select alpha & delta 

200 C solutions (in real-time mode). 


WRITE(14,60) TCUR, ICHL, ILEO, AZNAVT ( I LEO)*RAD , 

ELNAVT( ILE0)*RAD, DLNAV( ICHL, ISOL )*RAD, 

ALNAV( ICHL, I$OL)*RAD, ISOL, AZAHEAD( I LE0)*1D6, 
ELAHEAD(ILE0)*1D6 

FORMAT (// 1 TIME = \F12.3,' SEC' ,5X, • CHL ' , 12, 4X, 'LEO' , 12// 
8X,'AZ NAV =',F11.5,7X,»EL NAV =',F10.5,' (DEG)'/8X, 

•DELTA = * , F1 1 .5, 7X, 'ALPHA =',F10.5,' (DEG)',9X, 

1 SOL 1 , 12/8X, 1 A2 AHD =• ,F7.1, 11X, *EL AHD =',F6.1,6X, 

' (MICRORAD) •) 


OPEN(2, FI LE= 'AZEL .DAT 1 ,STATUS= 'OLD 1 ) 

DO 1=1 ,MIN(NLEOS,NCHANNEL$) 

READ (2,*) AZPRED 
RE AD (2,*) ELPRED 
AZNAVT ( I ) = AZPRED/RAD 
ELNAVT ( I ) = ELPRED/RAD 
ECLPNAV(I) = .FALSE. 

ECLPNAVSOON(I) = .FALSE. 

AZAHEAD(I) = 0 
ELAHEAD(I) = 0 

J = ICHLPRSEQ(I) 

CALL AZELALDL( AZNAVT , ELNAVT , I , J , 1 2, ALNAV,DLNAV) 

WRITE (*,90) I, AZPRED, ELPRED, DLNAV( J, 1 )*RAD, ALNAV(J,1 )*RAD, 
DLNAV( J,2)*RAD, ALNAVC J,2)*RAD 


1 
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90 

1 

2 

3 


FORMATC/' LEO 1 , 12, 7X, *AZ PRED 
1 (DEG) V/13X, 'DELTA 1 = ' 

' (DEG)* /13X, 'DELTA 2 =• 

' (DEG)') 


= 1 , F 1 1 . 5 , 6X , 'EL PRED F11.5 
F1 1 .5, 6X, 'ALPHA 1 =',F11.5 
F11.5,6X, 'ALPHA 2 = ' # F1 1 .5^ 




91 


DO WHILE (.NOT. DONE) 

WRITE(\91) 

FORMATC/ 1 Select solution (1 or 2)») 

READ(*,*) IALDLSOLCJ) 

EN0 I D0 IALDLSOL(J> ‘ EQ ' 1 ' 0R ‘ ,ALDLS0l <.O.EQ.2) DONE 


= .TRUE. 


END DO 


RETURN 

END 
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C 

C 

c 

c 

c 


SUBROUT 1NE AZELALDLt AZ.EL , I LEO, ICHL , 1 SOL , AL ,DL > 

This routine transforms FOV azinuth & elevation to 
arm angle alpha and disc angle delta. 

Prototype Version 1.0 Avtec Systems, Inc. 


Azimuths of LEO satellites 


August 1992 


10 

C 

Inputs: 

11 

C 


12 

C 

AZ 3 i 

13 

c 

EL 3 

14 

c 

I LEO = 

15 

c 

ICHL 3 

16 

c 


17 

c 

ISOL 3 

18 

c 


19 

c 

1 

20 

c 


21 

c 

Outputs: 

22 

c 


23 

c 

ALCICHL, 

24 

c 

DL( ICHL , 

25 

c 


26 

c- 


27 

28 


IMPLICIT 

29 


REAL*8 A 

30 


INCLUDE 

31 


INCLUDE 


LEO satellite index 
Channel index 


2 for solution #2 


32 

33 

34 

35 

36 

37 

38 

39 

40 

41 

42 

43 

44 

45 

46 

47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 
61 
62 

63 

64 

65 

66 
67 


DATA INIT /I/ 

IF(INIT.EQ.I) then 

THREEHALFP1 3 3*HALFPI 

TANHALF = DTAN(FOVDEG*HALFPI/180) 
IF(ARML.LE.I) STOP 111 
INIT=0 
END IF 

XF = DTAM(AZ(ILEO)) / TANHALF 
YF = DTAN(ELCILEO)) / TANHALF 

RF = DSORT(XF**2 + YF**2> 

IF(RF.EQ.O) STOP 112 
IF(RF.GT.I) STOP 112 

THETA = DATAN2(YF,XF) 

PHI = 0 ACOS ( R F / ( 2*ARML ) ) 

IFOSOL.EQ.1 .OR. ISOL.EQ.12) THEN 
DELTA = HALFP1 - THETA + PHI 
IF(DELTA.GT.PI) DELTA = DELTA - TUOPI 
DL(ICHL,1) = DELTA 
AL( ICHL, 1 ) = THREEHALFPI - 2*PHI 

END IF 

IFdSOL.EQ.2 .OR. 1S0L.EQ.12) THEN 
DELTA = HALFPI - THETA - PHI 
IF(DELTA.GT.PI) DELTA = DELTA - TWOPI 
DLdCHL.2) = DELTA 
AL(ICHL,2) = 2*PHI - HALFPI 

END IF 

RETURN 

END 
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1 BLOCK DATA 

2 

3 IMPLICIT REAL*8 (A-H,0-Z) 

4 


5 

/ 

INCLUDE 'ATTBLK.FCB' 


o 

7 

8 
9 

INCLUDE 'CIRCBLK.FCB' 


INCLUDE 'DISCBLK.FCB 1 


10 



11 

INCLUDE 1 FOVBLK.FCB' 


12 



13 

INCLUDE 'MISCBLK. FCB' 


14 



15 

INCLUDE 'ORBITBLK. FCB 1 


16 



17 

INCLUDE 1 SAVEBLK. FCB 1 


18 



19 

DATA NACQS /0/ 

! Number of acquisitions 

20 

DATA TSMALLSCAN /1D30/ 

! Earliest time for small scan pattern (sec) 

21 



22 

DATA PI /3 . 1 4 1 59265358979300/ 

23 

DATA TWOPI /6. 28318530717958600/ 

24 

DATA HALFPI /I .57079632679489700/ 

25 

DATA RAD /5 .7295 7795 13 0823 2D 1/ 

26 



27 

DATA DISCDEGMAX /2.4D2/ 

! Maximum disc rotation (deg) 

28 

DATA DISCVEL /7.7D0/ 

! Disc slew velocity (deg/sec) 

29 

DATA DISCACC /2. 67403/ 

! Disc acceleration (deg/sec**2) 

30 

DATA DISCACCTM /2. 880-3/ 

* Disc acceleration time (sec) 

31 

DATA DRAT 10 /2.7294D0/ 

! Ratio of disc diameters 

32 

DATA ALSETDEG /9D1/ 

! AL = 90deg when discs A & B are at step 0 

33 

DATA NSTEPS /708000/ 

! Number of disc steps per revolution 

34 

DATA DLDEGPARK /0D0/ 

! Park at delta = 0 deg 

35 

DATA ALDEGPARK /35D0/ 

! Park at alpha = 35 deg 

36 

DATA ISTEPAPARK /0/ 

! Park at delta = 0 deg 

37 

DATA ISTEPBPARK /39630/ 

! Park at alpha = 35 deg 

38 



39 

DATA FOVOEG /2.2D1/ 

! Field of view (deg) 

40 

DATA 8EAMU /.5D-4/ 

! HEO beamwidth (rad) 

41 

DATA ARML /I. 39600/ 

! Arm pivot length relative to radius of FOV 

42 



43 

DATA TEST /.FALSE./ 

! Real-time test flag 

44 



45 

DATA EPHH /2D- 1/ 

! Ephemeris uncertainty for HEO orbit (km) 

46 

DATA EPHl /5D- 1/ 

! Ephemeris uncertainty for LEO orbits (km) 

47 



48 

END 
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SUBROUTINE CNTRLFN(ECLPNAV, AZNAVT ,ELNAVT # IALDLSOL,AZAHEAD,ELAHEAD, 

1 ECLIPSE, MODE, INITDIR, INTRACK, SCANRES, ICHL, I LEO, 

2 AZS,ELS, TCUR) 

C The Control Function consists of: 

C 

C Offset Processor: Error Processor, Offset Generator, and Scan Generator 

C 

C Disc & Arm Controller: Determines angles for Disc Drivers 

C 

C Prototype Version 1.0 Avtec Systems, Inc. August 1992 
C 

C Inputs: 

C 

C ECLPNAV = Eclipse flags from Navigation Processor data 

C AZNAVT = Azimuths of LEO satellites from Navigation Processor data 

C ELNAVT = Elevations of LEO satellites from Navigation Processor data 

C IALDLSOL = Selected alpha & delta solutions (1 or 2) 

C AZAHEAD = Azimuth point -ahead angles 

C EL AHEAD = Elevation point -ahead angles 

C ECLIPSE = Eclipse flags from Scene Processor 

C MODE = Channel modes 

C INITDIR = Initialize disc direction flags 

C INTRACK = In-track flags 

C SCANRES = Scan reset flags 

C ICHL = Channel index 

C I LEO = LEO satellite index 

C AZS = Azimuths of LEO satellites from Scene Processor 

C ELS = Elevations of LEO satellites from Scene Processor 

C TCUR = Current time 

C IRATE = Tracking rate (MISCBLK) 

C REALTIME = Real-time flag (MISCBLK) 

C TRKGAIN = Tracking gain (MISCBLK) 

C UFLAG = Write flag (MISCBLK) 

C NACQS = Number of acquisitions (ATT8LK) 

C 

C Outputs: 

C 

C MODE (ICHL) = Channel mode 

C INTRACK(ILEO) = In-track flag 

C NACQS = Number of acquisitions (ATTBLK) 

C ISTEPASAVE = Disc A resolution step in real-time mode (SAVEBLK) 

C I STEPBSAVE = Disc B resolution step in real-time mode (SAVEBLK) 

C 

C 

IMPLICIT REAL*8 (A-H,0-Z) 

REAL*8 AZNAVT (6) , ELNAVT(6) ,AZAHEAD(6),ELAHEAD(6),AZS(6),ELS(6) 

REAL*8 AZSCAN(6),ELSCAN(6),ACQDWEND(6) 

REAL*8 AZSUM(6) ,ELSUM(6),AZERR(6) ,ELERR(6),U(6),V(6) 

REAL*8 AZ0FFSET(6),EL0FFSET (6) , AZOFFSETP(6) ,EL0FFSETP(6) 

REAL*8 AL(6,2), DL(6,2),ALSTEP(6) 

REAL*8 DLA(6),DLB(6),DLATRUE(6) ,DLBTRUE(6) , ALTRUE(6) 

INTEGER*4 ISTEPA(6), ISTEPB(6), ISTEPAOLD(6), ISTEPB0LD(6) 

INTEGERS ISTEPATRUE(6) , ISTEPBTRUE(6) 

INTEGER*4 INHSTEPS, INHC0UNT(6) , INHCHECK(6) 

INTEGER*2 IALDLSOL(6) , INITCHL(6), INITDIR(6) 

LOGICAL ECLPNAV(6) ,ECL IP$E(6), INTRACK(6) , SCANRES(6) 

CHARACTER DASH(79)*1 ,MODE(6)*13, INHMODE(6)*13,MODECHG*13 
INCLUDE 'ATTBLK. FCB' 

INCLUDE ’CIRCBLK. FCB' 

INCLUDE 'DISCBLK.FCB' 

INCLUDE 1 FOVBLK. FCB 1 
INCLUDE 'MISCBLK. FCB' 

INCLUDE 'SAVEBLK. FCB' 

DATA ACQDWDUR /ID-1/ ! Duration of an acquisition dwell (sec) 

DATA ISTEPTOLA /10/ ! Disc step tolerance for starting acquisition 

DATA ISTEPTOLT /50/ ! Disc step tolerance for tracking 

DATA FACTORINH /1.5D0/ ! Scan inhibit step factor 

DATA DASH /79*'-'/ 
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DATA INITCHL /6*1/ 

data init /I/ 

?|;'r // ‘ : ® “5? ' L,,UE /6 *°° 0/ 

data ISTEPAOLD /6*0/, ISTEPBOLD /6*0/ 

IF(INIT.EQ.I) then 

ORTRBEAM = BEAMW/4 
DLPARK = DIDEGPARK/RAD 
ALPARK = ALDEGPARK/RAD 
ACODWOUR = ACODUOUR • ID-5 

iSam^tLc INT(NSTEPS *°I SCDEGMAX/3 .602) 

MAXSLEWSTEPS = DISCVEl/IRATE * NSTEPS/3.602 

IF< MAXTSirJcTc GE ' 5D ' 1/IRATE > THEN 
els MAXTRACKSTEPS = DISCACC/(2*IRATE)**2 * NSTEPS/3.602 

MAXTRACKSTEPS = CD I SCACC*D I SCACCTM**? + 

' END ,f'^>W„ M „ MI E.S, S ?, c - crH)) . <STEps/J 602 

20 

'TIT C0NTR0L FUNCTION '// 1 1 ,79A1 ) 

END IF 

IF(TEST) THEN 

MODE(ICHL) = 'TRACKING' 

AZOFFSET(ILEO) = o 
ELOFFSET(ILEO) = o 
end if 

IF(WFLAG) WRITEC15.40) TCUR ICHI nen 
40 FORMAT(// ' TIHE =',F12.3, ' SEC\5X^CHL' , I2,4X, ' LEO', 12) 


C----f-- the true disc P° sition s. 


42 FORMAT C//3X, 'TRUE p6siTl2vi7X 'STEP^i 

1 /17X, 'DELTA A -'.F11.5 5X DELTA 8 / pi I'V ' 5X ' ' STEP B = M" 

2 /42X, 'ALPHA --'[nul,' “ ' F11 ‘ 5 ' (DEG) ‘ 

c sitTf: 

c change mode to 'acquisition 1 . P ° Se t0 P rev,ous commands, then 

IF(M00E(ICHL).EQ. 'SLEW TO ACO' .AND. .NOT.ECLPNAV(ILEO)) THEN 
IF(INITDIR(ICHL).EQ.O .AND 

J KSKffiSfSSSSS !! :S: iSSSJ.-s 

MOOE(ICHL) = 'ACQUISITION' 

WRITE (20 ,47) TCUR.ICHL 

47 FORMAT(/' TIME =',F12.3,' SEC' 8X 'CHANNFt ' ,? 

1 ' ACQUISITION STARTED' ) * * CHANMEL '» I 2. 

END A fF DWEND(ILE0> = TCUR + AC0DWDUR 

END IF 
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150 

]\l IF(MOOE( 1CHL) .EQ. 'SLEW TO REACQ') THEN 

| , iF< :r B ir«sis ;S: 

]56 MODE(ICHL) = 'REACQU1SITION' 

S 48 FORMATl/'^TIME 0 ^' P|2^3^^SEC‘ ,8X, 'CHANNEL' ,12, 

159 1 . REACQUISITION STARTED ) 

J5J ACQDWENDOLEO) = TCUR ♦ ACQDUDUR 

163 END ,F 

164 END IF 

165 

1 F(WFLAG) then 

168 WRITE(15,55) HOOECICHL) 

169 55 F0RMAT(/A16) , 

170 MOOECHG = ' 

171 END IF 

172 * 

IS 

51 C ,F(MOCiE(ICHL).EQ- 'ACQUISITION' -OR. MOOEOCHLJ.EQ. ^ACQUISITION' 

JS i ,F T E h»euchl>.eq.*trac<ing-)Then 

179 

11? c if "eclipsed, the LEO is not in track. 

182 

I F(ECLIPSE( ILEO)) THEN 

INTRACK(ILEO) = .false. 

187 TFfUFLAG) WRITE(15 # 60) 

is 60 

iH - 

193 

194 ELSE 

195 

! 9 9 6 7 ^ ious — "*• then 9et informat,on 

198 C from the Angle Processors. 

199 c — 

IS! 2 '=S’I ™ E » 

204 

205 call angleprcazs.els.azahead.elahead.dlatrue, 

206 CALL ANGLfcH a LT ruE,1lEO.ICHL.INTRACK.U.V) 

207 1 

208 — " 

2 2 ; 9 o ,acquisition ‘ or ,reacquisition ' 

211 C then change mode to 'Tracking. 

212 

2 !^ I F ( I NTRACKC 1 LEO ) ) THEN 

Z 14 

215 ,f<MOOE(ICHL).EQ.'ACQUIS1TION') then 

21 t NACQS = NACQS + 1 

lie SS5S*. 7 ?!JS:SS S . ' SEC ,8X, 'CHANNEL* ,12, 

219 70 '“"ACQUISITION COMPLETED’ ) 

220 1 
221 


END IF 
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I F(MODE( ICHL) .EQ. 'REACQUISITION' )WRITE(20,72)TCUR, ICHL 
72 FORMAT(/' TIME =',F12.3,' SEC 1 , 8X , * CHANNEL 1 , 1 2 , 

1 ' REACQUISITION COMPLETED') 

IF(MOOE(ICHL).NE. 'TRACKING') THEN 
MOOE(ICHL) = 'TRACKING' 

MOOECHG = 'TRACKING' 

END IF 

C 

C Error Processor transforms u,v errors from Angle Processors to 
C azimuth and elevation. 

C 

ROT = HALFPI + DLA(ICHL) + ALSTEP(ICHL) 

COSROT = DCOS(ROT) 

SINROT = DSIN(ROT) 

AZERR(ILEO) = U( I LE0)*C0SR0T ♦ V( ILEO)*SINROT + 

1 AZAHEADC I LEO) 

ELERR(ILEO) = -U( I LEO)*SINROT + V( ILE0)*C0SR0T + 

1 ELAHEADC I LEO) 

I F(WFLAG) WRITE( 15,80) U(ILEO)*1D6, V(ILE0)*1D6, 

1 AZERRC I LEO)*1D6, ELERR( I LEO)*1D6 

80 FORMATC17X, 'U ERR = ' , F1 1 . 1 ,5X, ' V ERR =',F11.1, 

1 « (MICR0RAD)'/17X, 'AZ ERR =' ,F11 .1 ,5X, 'EL ERR = ', 

2 F1 1 . 1 , ' (MICRORAD)') 

C 

C Offset Generator updates azimuth and elevation offsets with 
C respective errors. 

C 

AZOFFSET ( I LEO) = AZ0FFSET( I LEO) + TRKGAIN*AZERR( I LEO) 
ELOFFSET(ILEO) = EL0FFSETC I LEO) + TRKGAIN*ELERR( I LEO) 

ELSE 

I F(WFLAG) WRITE( 15,90) 

90 FORMAT (17X, ‘NOT IN TRACK / OUTSIDE HEO BEAM') 

IF(MOOE(ICHL).EQ. 'TRACKING') THEN 

I F(REALTIME) WRITE(20,95) TCUR,ICHL 
IF(. NOT. REALTIME) WRITE(20,96) TCUR,ICHL 

95 FORMAT(/ ' TIME =',F12.3,' SEC' ,8X, ' CHANNEL 1 , 1 2, 

1 ' NOT IN TRACK') 

96 FORMATC/' TIME =',F12.3,' SEC' ,8X, 'CHANNEL », 12, 

1 ' NOT IN TRACK / OUTSIDE HEO BEAM') 

END IF 

END IF 

C 

C If true disc steps are not close to previous commands, then change mode 
C to 'scan inhibit'. 

C 

ELSE 

INHMODE(ICHL) = MOOE(ICHL) 

INHCOUNT ( ICHL) = 1 
INHCHECK(ICHL) = 0 
MOOE(ICHL) = 'SCAN INHIBIT' 

I F(UFLAG) WRITE( 15, 55) MODE ( ICHL) 

WRI TE(20, 52) TCUR,ICHL 

52 FORMATC/ ' TIME =',F12.3,‘ SEC ' ,8X, 'CHANNEL \ 12, 

1 * SCAN INHIBITED') 

END IF 


END IF 



FILE: D:\TEMP\CNTRLFN . FOR Page: C140 

Size: 18910 Edited: 8-26-92, 4:23p Printed: 11-17-92, 2:30p 


296 

297 

298 

299 

300 

301 

302 

303 

304 

305 

306 

307 

308 

309 

310 

311 

312 

313 

314 

315 

316 

317 

318 

319 

320 

321 

322 

323 

324 

325 

326 

327 

328 

329 

330 

331 

332 

333 

334 

335 

336 

337 

338 

339 

340 

341 

342 

343 

344 

345 

346 

347 

348 

349 

350 

351 

352 

353 

354 

355 

356 

357 

358 

359 

360 

361 

362 

363 

364 

365 

366 

367 

368 

369 


C 

C If mode is 'tracking' and in-track flag is false: 

C In real-time, set mode to 'slew to reacq' and set previous tracking 

C offsets to zero. 

C In simulation, set mode to 'reacquisition' and save previous tracking 

C offsets. 

C Set scan reset flag to true. 

C 


IF(MOOE(ICHL).EQ. 'TRACKING' .AND. .NOT. INTRACK(ILEO)) THEN 

C Removed the following lines of code on 8-26-92 RJP 

C IF(REALTIME) THEN 

C HOOE(ICHL) = 'SLEW TO REACQ' 

C MOOECHG = 'SLEW TO REACQ' 

C AZOFFSETP(ILEO) = 0 

C ELOFFSETP(ILEO) = 0 

C ELSE 

MOOE(ICHL) = 'REACQUISITION' 

I F(WFLAG) WR I TEC 15,55) MODECICHL) 

WRITE(20,48) TCUR,ICHL 
AZOFFSETPC I LEO) = AZOFFSETC I LEO) 

ELOFFSETPC I LEO) = ELOFFSETC I LEO) 

C END IF 

SCANRESC I LEO) = .TRUE. 

END IF 

END IF 


C 

C If mode is 'park', set arm angle alpha and disc angle delta. 
C 


I F(MOOE( ICHL) .EQ. 'PARK' ) THEN 
ISOL = 1 

AL( ICHL, ISOL) = ALPARK 
DL( ICHL, ISOL) = DLPARK 

ELSE 


C 

C If mode is 'slew to acq' or 'acquisition' and a new scan position is 
C required, the Offset Generator uses the Scan Generator output. 

C 

I F((MODE( ICHL) .EQ. 'SLEW TO ACO' .AND. SCANRESC I LEO)) .OR. 

1 CMODECICHD.EQ. 'ACQUISITION' .AND. 

2 CSCANRESC I LEO) .OR . TCUR.GT .ACQDWENDC I LEO) ) ) ) THEN 

CALL SCANGNC I LEO, ICHL, MODE , SCANRES,TCUR,AZOFFSET,ELOFFSET ) 

I FCMODEC ICHL ) .EQ. 'ACQUISITION') 

1 ACQDWENDC I LEO) = TCUR ♦ ACQDWDUR 

C 

C If mode is 'slew to reacq' or 'reacquisition* and a new scan position is 
C required, the Offset Generator adds the Scan Generator output to the 

C previous tracking offsets. If mode is 'slew to reacq' these offsets were 

C set to zero. 

C 

ELSE I FCCHODEC ICHL) .EQ. 'SLEW TO REACQ* . AND. SCANRESC I LEO)) .OR. 

1 CMODECICHD.EQ. 'REACQUISITION ' .AND. 

2 CSCANRESC I LEO) .OR .TCUR. GT .ACQDWENDC I LEO) ) ) ) THEN 

CALL SCANGNC ILEO, ICHL, MODE, SCANRES, TCUR, AZSCAN,ELSCAN) 

AZOFFSETC I LEO) = AZOFFSETPC I LEO) ♦ AZSCANCILEO) 

ELOFFSETC ILEO) = ELOFFSETPC ILEO) ♦ ELSCANCILEO) 

IFCMOOECICHD.EQ. 'REACQUISITION') 

1 ACQDWENDC I LEO) = TCUR + ACQDWDUR 
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ELSE I F(MODE( ICHL ) .EQ. 'SCAN INHIBIT') THEN 

ELOFP^M.ini = ^ BEAM * C-1>**(1 + INHCOU«T(ICHl)/2) 
LOFFSET(ILEO) - QRTRBEAM * (-1 )**((1+IMHCOUNT( ICHL))/2) 


^ORMAT(1^ H -/[7 TE off^ 5 ’ «° F ; S E T ('LEO)*1D3, ELOFFSET(ILEO)*1D3 
FORhATq iTX, AZ OFFS = , F1 1 .4, 5X, 'EL OFFS = ' F1 1 L 
* (MILLIRAD)') ' ' 


from Navigation 


AZSUM(ILEO) = AZNAVT ( ILEO) + AZ0FFSET( I LEO) 
ELSUM(ILEO) = ELNAVT ( I LEO) + ELOFFSET( I LEO) 


isc angle delta. 


ISOL = IALDLSOLC ICHL ) 

CALL AZELAL0L(A2SUM,ELSUM, ILEO, ICHL, ISOL, AL,DL) 

END IF 

disc an9te delta are transformed to dis 


CALL ALDLDLAB(AL,DL, ICHL, ISOL, INITDIR TCUR,DLA,DLB 
1 ISTEPA, ISTEPB.ALSTEP) 

If mode is ‘scan inhibit' and changes in disc step comaands are smlll’*"" 

?^ h r f ° r acq ^®' t,on . or acquisition, change mode to ‘slew to acq‘ or 
slew to reacq' depending on previous mode. ^ 

I F(MOOE( ICHL) .EQ. 'SCAN INHIBIT') THEN 
I F( INHCOUNT ( I CHL ) . GE .2) THEN 

1 IF(I ^ (ISTEPA(ICHL )*ISTEPAOLO(ICHL)).LE.INHSTEPS .AND. 

IABS( ISTEPB( ICHL)- ISTEPBOLDC ICHL)) . LE . INHSTEPS) THEN 

I F ( INHCHECK( ICHL) .EQ.3) THEN 

I F( INHMOOE( I CHL) .EQ. 'ACQUISITION 1 ) THEN 
MODE(ICHL) - 'SLEW TO ACQ' 

MODECHG = 'SLEW TO ACQ' 

ELSE 

MODE(ICHL) = 'SLEW TO REACQ' 

MODECHG = 'SLEW TO REACQ' 

AZOFFSETP(ILEO) = 0 
ELOFFSETP(ILEO) = 0 
END IF 


SCANRES(ILEO) = .TRUE. 
END IF 


INHCHECK(ICHL) = INHCHECKC ICHL ) ♦ 1 
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ELSE 

INHCHECK(ICHL) = 0 
END IF 

END IF 

INHCOUNT ( ICHL ) = INHCOUNT ( ICHL) ♦ 1 
END IF 


tFfUFLAG) WRITE(15,50) MODECHG, DUICHL, ISOL)*RAD, 

1 KS 1 SOL )*RAD , I SOI, ISTEPA(ICHL), ISTEPB(ICHL), 

2 DLA(ICHL)*RAD, DLB( ICHL)*RAD, ALSTEP(ICHL)*RAD 

50 FORMATCA16/17X, 'DELTA .F] 1 ;5.5X, 'ALPHA 

1 5X, 'SOL 1 , 12/17X, 'STEP A =M11,5X, STEP B ITT/ 

2 17X 'DELTA A =• , F1 1 .5,5X, 'DELTA B = ,F11.5. (DEG) / 

3 42X 'STEP AL = ' , FI 1 .5 , ' (DEG)') 


(DEG) 


C In real-time mode, save disc step commands. 
C 


IF(REALTIME) THEN 
IF(TEST) THEN 

ISTEPASAVE = ISTEPAPARK 
ISTEPBSAVE = ISTEPBPARK 
ELSE 

ISTEPASAVE = ISTEPA(ICHL) 
ISTEPBSAVE = ISTEPB(ICHL) 
END IF 
END IF 

lNITCHL(ICHL) = 0 
ISTEPAOLD(ICHL) = ISTEPA(ICHL) 
ISTEPBOLD(ICHL) = lSTEPB(ICHL) 


RETURN 

END 



WN 


FILE: 

Size: 
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SUBROUTINE COPYVEC(U,N,V) 
REAL*8 U(N) , V(N) 

00 1=1, N 

V(I)=U(I) 

END DO 
RETURN 
END 



rvj k> ^ xr\ >o 


FILE: 
S i 2e : 


1 
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SUBROUTINE CROSS(U,V,W) 
REAL*8 U(3),V(3),W(3) 

W( 1 )=U(2)*V(3)-U(3)*V(2) 
W(2)=U(3)*V( 1 )-U(1 )*V(3) 
W(3)=U<1 )*V(2)-U(2)*V(1 ) 
RETURN 
END 


O:\TEMP\DFQ.F0fi 

661 Edited: 8-12-9? 0 /« 

- - P Pr,nted; H-17-92, 2:3o p P89e: CU5 


SUBROUTINE DFQ( X ,dx,0T) 

Differential equations for satel.ite state x. 
Courtesy of Boo Dasenbrock of NRL HodT 

implicit REAL*8 (A-H o 7, 

REAL *8 MU, MUR ' Z) 

DIMENSION X(6) 0Xf6) 

DATA mu /-3.986S£ 5/ 

DX(1)=x(4)*ot 

DX(2)=X(5)*DT 

DX(3)=X(6) ,v qj 

DX(4)=MUR*Xf1)*0T 

DX(5)=MUR*XC,V)*0T 

DX ( 6 ) =MUR *X ) *0 T 


27 

28 


RETURN 

END 
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C 

c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 
c 


th ic routine computes 

m simulation mode, this 

*” di!C Z"Z — —» - «• ** c p “" i0 "' 

in real-time mode, mi 
previously saved. 

Prototype Version 1.0 

Inputs: 


, nc August 1992 

Avtec Systems, l 


ISTEPAOLD 

ISTEPBOLD 

MODE 

INITCHL 

1CHL 

1STEPMAX 


j; cr a step conwands 
= Previous d sc A s P ^ 

- previous disc » slc P 

: 3SS 

iSSS*. ; ESKSSSSS 31 

srf" Sfst 

a - ss * s SJ s SKS «— “ 

ISTEPBSAVE 

Outputs: 

1STEPATRUE(1CHL> = True disc ^ - n simulation mode 

ISTEPBTRUEtjCHO - d i sc A ang i e (de^a A) s imulation mode 

0t S55t , lSt> • True d ’ SC 8 ^"ialS) simulation mode 

DUBTRUE(ICHL) _ arm angle (alpha) m 

ALTRUECICHU ' ,ru 

1NTEGER*2 INITCHK6) 

SSKtER-13 H00E(6), 

INCLUDE .CIRCB-B 
INCLUDE '01SCBLK.FCB 
INCLUDE 'M1SCBLK.FCB 
INCLUDE -SAVEBLK.FCB 


DATA ACCUR /2D0/ 
data f /ADO/ 
data maxsteperr / 2/ 

DATA 1N1T /I/ 


i KSoST-S'S" accuracy —l 
I Maximum random step error 


c — 
c 

c— 


UftlFl _ - 


IF (REALTIME) I „ jSTEPASAVE 

SSKB83B ■ 

RETURN 


C— 

c 

c 


END IF 



In simulation mode, ^ 


SSSU “ • 919CSTE9 
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ALSET = ALSETDEG / RAD 
DO 1=1,6 

CALL RNDM(UNIF) 
APHS(I) = TWOP I *UN I F 
CALL RNDM(UNIF) 
BPHS(I) = TWOPinJNIF 
END DO 
INIT=0 
END IF 


C 

C Compote the true disc steps. Simulation begins in park positions. 
C 


I F( INITCHLC ICHL) .EQ. 1 ) THEN 

JSTEPATRUE = ISTEPAPARK 
JSTEPBTRUE = ISTEPBPARK 

ELSE 

IF (MODE ( ICHL) .EQ. 'ACQUISITION' .OR. MODEC ICHL) .EQ. ' REACQUI SI T ION 1 
1 . OR. MOOECICHD.EQ. 'TRACKING') THEN 

MAXSTEPS = MAXTRACKSTEPS 
ELSE 

MAXSTEPS = MAXSLEWSTEPS 
END IF 

ISTEPDIFF = ISTEPAOLD(ICHL) - ISTEPATRUEOLD( ICHL) 

JSTEPATRUE = I STEPATRUEOLD( ICHL) + 

1 ISIGNC1, ISTEPDIFF) * MI N(MAXSTEPS, IABS( ISTEPDI FF ) ) 

ISTEPDIFF = ISTEPBOLD(ICHL) - ISTEPBTRUEOLD( ICHL) 

JSTEPBTRUE = ISTEPBTRUEOLD< ICHL) + 

1 ISIGN(1, ISTEPDIFF) * MIN(MAXSTEPS, IABS( I STEPDI FF ) ) 

END IF 


C 

C Include random disc step errors. 
C 


I F( INITCHLC ICHL) .EQ. 1 .OR. 

1 (MODEC ICHL) .EQ. 1 PARK' .AND. JSTEPATRUE. EQ. ISTEPAPARK)) THEN 
DLRNDMA = DISCSTEP * ISTEPAPARK 
ELSE 

CALL RNDM(UNIF) 

DLRNDMA = DISCSTEP * (JSTEPATRUE + (2*UNIF-1) * MAXSTEPERR) 
I F (DABS (DLRNDMA ) .GT .DLMAX) DLRNDMA = DSIGN(DLMAX, DLRNDMA) 
JSTEPATRUE = NINT (DLRNDMA/DISCSTEP) 

END IF 

I F( IN ITCHL( ICHL) .EO. 1 .OR. 

1 (MODEC ICHL). EQ. 'PARK' -AND. JSTEPBTRUE .EQ. I STEPBPARK) ) THEN 
DLRNDMB = DISCSTEP * ISTEPBPARK 
ELSE 

CALL RNDM(UNIF) 

DLRNDMB = DISCSTEP * (JSTEPBTRUE + <2*UNIF-1) * MAXSTEPERR) 
I F (DABS (DLRNDMB ) .GT .DLMAX) DLRNDMB = DSIGNCDLMAX , DLRNDMB) 
JSTEPBTRUE = NINT (DLRNDMB/DI SCSTEP) 

END IF 

ISTEPATRUEC ICHL) = JSTEPATRUE 
ISTEPBTRUEC ICHL) = JSTEPBTRUE 


C 

C Determine true disc and arm angles. 
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148 C 

149 

150 DLATRUE(ICHL) = DLRNDMA + ERRAMPL * DS1N< F*DLRNDMA + APHS(ICHL)) 

151 DLBTRUEC ICHL) = DLRNDMB + ERRAMPL * DSIN< F*DLRNDMB + BPHS(ICHL)) 

152 

153 ALTRUE(ICHL) = ALSET + DRATIO * (DLATRUE( ICHL) -DLBTRUEC ICHL)) 

154 

155 C 

156 C Save true disc steps. 

157 C 

158 

159 I STEPATRUEOLD( ICHL ) = JSTEPATRUE 

160 ISTEPBTRUEOLD(ICHL) = JSTEPBTRUE 

161 

162 RETURN 

163 END 


cy ro vt in 
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REAL*8 FUNCTION D0T(U,V) 

REAL*8 U(3),V(3> 

D0T=U(1 )*V(1 )+U(2)*V(2)+U(3)*V(3) 

RETURN 

END 
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2 C 

3 C 

4 C 

5 C 

6 C 

7 C 

8 C 

9 C 

10 C 

11 C 

12 C 

13 C 

14 C 

15 C 

16 C 

17 C 

18 C 

19 

20 
21 
22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

32 

33 

34 

35 

36 

37 

38 

39 

40 

41 

42 

43 

44 

45 

46 

47 

48 

49 

50 

51 

52 

53 

54 


SUBROUTINE ELSTAT (ELD f X) DEGREES 

ELD IN THE INPUT KEPLERIAN STATE IN KM AND DEGREES 

X IS THE OUTPUT CARTESIAN STATE IN KILOMETERS 
ELD< 1 )=SEMI -MAJOR AXIS (KM) 

ELD(2)=ECCENTRICITY 
ELD(3)=INCL1NATI0N (DEG) 

ELD(4)=LON OF ASC NODE (DEG) 

EID(5)=ARG OF PERIGEE (DEG) 




X(1)=X (KM) 
X(2)=Y (KM) 
X(3)=Z (KM) 
X(4)=XDOT (KM/S) 
X(5)=YDOT (KM/S) 
X(6)=ZD0T (KM/S) 


IMPLICIT REAL*8 (A-H,0-Z) 

DIMENSION X(6), ELD(6) , A(3,2) 

XMU =398600.800 

P 1 =3 . 1 41 592653589793238D0 

DTR=PI/180.0DO 

SNI=DSIN(ELD(3)*DTR) 

CNI=DC0S(ELD(3)*DTR) 

$0M=DSIN(ELD(4)*DTR) 

COM=DCOS(ELD(4)*DTR) 

XM=DMOD(ELD(6),360.0D0)*DTR 

ECC=ELD(2) 

E=XKEP(ECC,XM,1.0D-14) 


SINE=DSIN(E) 

STA=SQRT(l!oDO-ECC**2)*SINE/(1.0DO-ECC*COSE) 

CT A= ( COSE - ECC )/ ( 1 . 0D0 - ECC*COSE ) 
TAA=ARKTNS(180,CTA,STA) 

TBB=TAA*DTR*ELD(5) 

CBA=DCOS(TBB) 

SBA=0SIN(TBB) 

A(1 1)=+COM*CBA-SOM*CNI*SBA 
A(2, 1 )=+SOM*CBA+COM*CNI*SBA 

A(3* 1 )=+SNI*SBA 

A( 1 2)=-COM*SBA-SOM*CNI*CBA 
A(2,2)=-SOM*SBA+COM*CNI*CBA 

A(3*2)= + SNI*CBA 
P=ELD(1 )*(1 .0D0-ECC**2) 

R=P/(1.000+ECC*CTA) 

'**^***!2!PZi nnnfci n.1 U-VR*VR) 


DO 10 K=1 ,3 
X(K)=R*A(K, 1 ) 

10 X(K+3)=VR*A(K,1)+VT*A(K,2) 


RETURN 

END 
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1 C 

2 

3 FUNCTION GAUSCL (XMEAN, SIGMA, CUTOFF) 

4 

5 C GENERATES A RANDOM NUMBER FROM A CLIPPED GAUSSIAN DISTRIBUTION, WHERE 

6 C THE TAILS ARE CUT OFF. 

7 C 

8 C INPUTS: 

9 C XMEAN = MEAN OF GAUSSIAN DISTRIBUTION 

10 C SIGMA = STANDARD DEVIATION OF GAUSSIAN DISTRIBUTION 

11 C CUTOFF = CUTOFF VALUE IN UNITS OF SIGMA 

12 C 

13 C OUTPUT: 

14 C GAUSCL = RANDOM NUMBER FROM CLIPPED GAUSSIAN DISTRIBUTION 

15 C 

16 C 

17 

18 IMPLICIT REAL*8 <A-H,0-Z) 

19 50 GAUSCL = GAUSS(0D0, IDO) 

20 I F(DABS(GAUSCL ) .GT. CUTOFF) GO TO 50 

21 GAUSCL = XMEAN + GAUSCL*SIGMA 

22 RETURN 

23 END 
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1 

2 

3 FUNCTION GAUSS (XMEAN , VARIANCE) 

4 

5 C GENERATES A RANDOM NUMBER FROM A GAUSSIAN DISTRIBUTION 

6 C 

7 C INPUTS: 

8 C XMEAN = MEAN OF GAUSSIAN DISTRIBUTION 

9 C VARIANCE = VARIANCE OF GAUSSIAN DISTRIBUTION 

10 C 

11 C OUTPUT: 

12 C GAUSS = RANDOM NUMBER 

13 C 

14 C REFERENCE: 

15 C L.R. RABINER AND B. GOLD, "THEORY AND APPLICATION OF DIGITAL SIGNAL 

16 C PROCESSING", PRENTICE-HALL, ENGLEWOOD CLIFFS, NJ, 1975, pp. 570-571. 

17 C 

18 

19 

20 IMPLICIT REAL*8 (A-H,0-Z) 

21 

22 DATA TWOP 1/6. 2831 853071 79586500/ 

23 

24 CALL RNDMCX1) 

25 CALL RNDMCX2) 

26 Y = DSQRT ( -2*VARIANCE*DL0G(X1 ) ) 

27 GAUSS = XMEAN + Y*DCOS(TWOPI*X2) 

28 RETURN 

29 END 
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1 C 

2 


3 

/ 


SUBROUTINE INTRFACE 

H 

5 

C 

Interface between control software and executive program. 

6 

C 



7 

c 

Prototype Version 1.0 Avtec Systems. Inc. August 1992 

8 

c 



9 

c 

Entry points: 


10 

c 



11 

c 

INIT 

Initialization of control software 

12 

c 

POSITION 

Computation of new position commands for a disc channel 

13 

c 



14 

c 

Inputs: 


15 

c 



16 

c 

REALTIMEFLAG 

= Real-time flag (LOGICAL), argument in ENTRY INIT: 

17 

c 



18 

c 


True indicates real-time mode 

19 

c 


False indicates simulation mode 

20 

c 



21 

c 

In real-time 

mode: 

22 

c 



23 

c 

Input file name is INPUT.DAT 

24 

c 

Az-El file name is AZEL.DAT (see SUBROUTINE ASGNMFN) 

25 

c 



26 

c 

In simulation mode, input file name (CHARACTER*12) is entered from 

27 

c 

the keyboard 

28 

c 



29 

c 

The following inputs are contained in the input file: 

30 

c 



31 

c 

SIMHRS 

Duration of simulation in hrs (REAL*8) 

32 

c 


(used only in simulation mode) 

33 

c 



34 

c 

NCHANNELS = 

Number of disc channels (INTEGER: 1-6) 

35 

c 



36 

c 

IRATE 

Tracking rate in Hz (INTEGER) 

37 

c 



38 

c 

TRKGAIN 

Tracking gain (REAL*8) 

39 

c 



40 

c 

WFLAG - 

Write flag for output from the Truth Generator, Scene 

41 

c 


Processor, Navigation Processor, Assignment Function 

42 

c 


and Control Function (LOGICAL, false in real-time mode) 

43 

c 



44 

c 


Output file names (CHARACTERS) are entered from 

45 

c 


the keyboard 

46 

c 



47 

c 

HEL(J) 

Classical orbital elements for HEO at time 0 (REAL*8): 

48 

c 



49 

c 

(1) 

Semi -major axis (km) 

50 

c 

(2) 

Eccentricity 

51 

c 

(3) 

Inclination (deg) 

52 

c 

(4) 

Longitude of ascending node (deg) 

53 

c 

(5) 

Argument of perigee (deg) 

54 

c 

(6) 

Mean anomaly (deg) 

55 

c 



56 

c 

NLEOS 

Number of LEO satellites (INTEGER: 1-6) 

57 

c 



58 

c 

LEL( J, I ) = 

Classical orbital elements for LEO I at time 0 (REAL*8) 

59 

c 



60 

c 

Outputs: 


61 

c 



62 

c 

Event Log 


63 

c 



64 

c 

Truth Generator (if WFLAG is true) 

65 

c 

Scene Processor (if WFLAG is true) 

66 

c 

Navigation Processor (if WFLAG is true) 

67 

c 

Assignment Function (if WFLAG is true) 

68 

c 

Control Function (if WFLAG is true) 

69 

c 



70 

c 

In real-time 

mode, Event Log file name is EVENT.DAT 

71 

c 



72 

c 

In simulation 

i mode, output file names (CHARACTERS) are entered from 

73 

c 

the keyboard 
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C 

C 


IMPLICIT REAL*8 <A-H,0-Z) 

REAL*8 U [FAR] 

REALMS V [FAR] 

REAL*8 HEL(6),LEL(6,6>,HE0(6),LE0(6 f 6>,MU 
INTEGERS ISTEPA [FAR] 

INTEGERS ISTEPB [FAR] 

INTEGERS ICHANNEL [FAR] 

INTEGER*2 ICHLORDER<6) , ICHLPRSEQC6) , ICHLLEO(6),LEOCHL<6) 
CHARACTER*^ FILENAME 
LOGICAL REALTIMEFLAG [FAR] 

LOGICAL INTRACK [FAR] 

LOGICAL DONE 
INCLUDE 'CIRCBLK. FCB 1 
INCLUDE 'MISCBLK.FCB* 

INCLUDE 'ORBITBLK.FCB' 

INCLUDE 1 SAVEBLK. FCB 1 

DATA ICHLORDER /I ,2, 3, 4, 5, 6/ 

DATA I ORDER /0/ 

DATA ICHLPRSEO 71,2,3,4,5,6/ 

DATA ILEOSEQ /0/ 

DATA LEOCHL /6*0/ 

DATA ICHLLEO /6*0/ 

DATA INI TP /I/ 

DATA RE /6. 37814503/ 

DATA MU /3. 98600805/ 


! Channel command order 
! Channel order index 
I Channel priority sequence 
! LEO sequence 
! LEO channel assignments 
I Channel LEO assignments 
! Initialization of ENTRY POSITION 

! Earth radius (km) 

! Gravitational parameter 


ENTRY INI T(REALT IMEFLAG) 

C Initialization of control software. 



REALTIME = REALTIMEFLAG 

I F(REALTIME) THEN 

OPE N ( 1 , F I LE= 1 1 NPUT . DAT ' , STATU$= ' OLD ' ) 

ELSE 

WRITEC*, 1 ) 

1 FORMAT ( 1 Enter input file name (e.g., Up to 8 characters.DAT)') 
READ(*,2) FILENAME 

2 FORMAT (A) 

OPEN ( 1 , FILE-FI LENAME , STATUS* • OLD * ) 

END IF 



C Read input variables. 




READ ( 1 ,*) SIMHRS ! Used only in simulation mode 

READ ( 1 ,*) NCHANNELS 

READ ( 1 ,*) IRATE 

READ(1,*) TRKGAIN 

READ(1,*> WFLAG 

I F ( REAL T I ME ) WFLAG = .FALSE. 

I F(NCHANNELS. LT . 1 .OR. NCHANNELS. GT .6) STOP 151 
I F < I RATE - LT - 1 ) STOP 152 
IF(TRKGAIN.LE.O) STOP 153 




C Read classical orbital elements for HEO and up to 6 LEO satellites 
C at time 0 and transform to geocentric- equatorial coordinates and 
C velocity components. 

C 


DO J=1 ,6 

READ( 1 ,*) HEL(J) 
END DO 
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IF(HEL(1>.LE.RE) STOP 161 
I F(HEL(2) .NE .0) STOP 162 

IF(HEL(3) .LT.O .OR. HEL<3) .GT . 180) STOP 163 
DO J=4 ,6 

I F(DABS( HEL( J ) ) .GE.360) STOP 164 
END DO 

TEMP = TWOPI / DSQRT(MU) 

PRDH = TEMP * HEL(1)**1.5D0 
CALL ELSTAT ( HEL , HEO) 

READ(1 ,*) NLEOS 

I F(NLEOS.LT. 1 .OR. NLEOS. GT. 6) STOP 154 
DO 1=1, NLEOS 
DO J=1 ,6 

READO,*) LEL(J.I) 

END DO 

I F(LEL(1 , 1 ) .LE.RE) STOP 161 

IF(LEL(2, I ).LT.0 .OR. LEL(2, I ) . GE . 1 ) STOP 162 

I F(LEL(3, I ) .LT.O .OR. LEL(3, I ) . GT . 180) STOP 163 

DO J=4 ,6 

I F(DABS( LEL( J , I ) ) .GE .360) STOP 164 
END DO 

PRDL(I) = TEMP * LELC1, I)**1.5D0 
CALL ELSTAT ( LEL( 1 , I ) , LEO( 1,1)) 

END DO 


C 

C In real-time mode, read the predicted Az & El of LEO satellites and 
C select alpha & delta solutions. 

C 


I F(REALTIME) CALL ASGNMFNR(NLEOS,NCHANNELS, ICHLPRSEQ) 


C 

C Read the names of output files. 
C 


I F(WFLAG) THEN 
WRITE(*,41) 

41 FORMAT ( ' Enter file name for Truth Generator output', 

1 1 (e.g.. Up to 8 characters.DAT)') 

READ(*, 2) FILENAME 

OPEN( 1 1 , F I LE=FI LENAME , STATUS= ' NEW ) 

WR I TEC* ,42) 

42 FORMAT ( 1 Enter file name for Scene Processor output 1 , 

1 ' (e.g., Up to 8 characters.DAT)') 

READ(*,2) FILENAME 

OPEN(12, FILE=FILENAME,STATUS=' NEW ) 

WR I TE(* f 43) 

43 FORMAT (' Enter file name for Navigation Processor output', 

1 1 (e.g., Up to 8 characters.DAT)') 

READ(*,2) FILENAME 

OPEN ( 1 3 , F I LE=F I LENAME , STATUS= ' NEW ) 

WRITE (*,44) 

44 FORMAT (' Enter file name for Assignment Function output', 

1 1 (e.g.. Up to 8 characters.DAT)') 

READ(*,2) FILENAME 

OPEN( 14, F I LE=F I LENAME ,STATUS= ' NEW ) 

WRITE (*,45) 

45 FORMAT (' Enter file name for Control Function output', 

1 ' (e.g.. Up to 8 characters.DAT)') 


READ(*,2) FILENAME 
0PEN(15,FILE=FILENAME,STATUS= , NEW'> 


222 

223 

224 

225 

226 

227 

228 

229 

230 

231 

232 

233 

234 

235 

236 

237 

238 

239 

240 

241 

242 

243 

244 

245 

246 

247 

248 

249 

250 

251 

252 

253 

254 

255 

256 

257 

258 

259 

260 
261 
262 

263 

264 

265 

266 

267 

268 

269 

270 

271 

272 

273 

274 

275 

276 

277 

278 

279 

280 
281 
282 

283 

284 

285 

286 

287 

288 

289 

290 

291 

292 

293 

294 

295 


END IF 

I F(REALTIME) THEN 

OPEN(20, F I LE=* EVENT. DAT ' ,STATUS=' UNKNOWN*) 

ELSE 

WRITE(*,46) 

46 FORMAT ( 1 Enter file name for Event Log output', 
1 1 (e.g.. Up to 8 characters.DAT)') 

READ(*,2) FILENAME 

OPEN ( 20 , F I LE=F I LENAME , STATUS= ' NEW 1 ) 

END IF 

WRITE(20,60) 

60 FORMAT (// 1 EVENT LOG'/' ') 

TCUR = 0 

TSTOP = SIMHRS*3.6D3 

DT = 1D0/(IRATE*NCHANNELS) 

RETURN 


C 

ENTRY POSITION ( ICHANNEL, INTRACK, U f V f ISTEPA, ISTEPB) 

C Computation of new position commands for a disc channel. 

C 

C Inputs (real-time mode only): 

C 

C ICHANNEL = Channel index 

C INTRACK = In-track flag 

C U, V * Tracking detector errors (rad) 

C ISTEPA = Current disc A resolution step 

C ISTEPB = Current disc B resolution step 

C 

C Outputs (real-time mode only): 

C 

C ISTEPA = New command for disc A resolution step 

C ISTEPB * New command for disc B resolution step 

C 

C 

C 

C In real-time mode, save Angle Processor inputs and current disc step 

C positions. Also update current time and determine LEO satellite index. 

C Note: all channel assignments are performed in SUBROUTINE ASGNMFN. 

C 


I F(REALTIME) THEN 

I F(U.GT. 1 D 1 .OR. V.GT.1D1) THEN 
TEST = .TRUE. 

INTRACK = .TRUE. 

U = 0 
V = 0 
ELSE 

TEST = .FALSE. 

END IF 

INTRACKSAVE = INTRACK 
USAVE = U 
VSAVE = V 

ISTEPASAVE = ISTEPA 
ISTEPBSAVE = ISTEPB 

ICHL = ICHANNEL 
I ORDER = 0 
DONE = .FALSE. 

DO WHILE (.NOT. DONE) 

I ORDER = I ORDER ♦ 1 
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296 



I F( IORDER.GT .NCHANNELS) STOP 114 

297 



ICHLORD = ICHLORDER(IORDER) 

298 



I F( I CHL .EG. ICHLORD) DONE = .TRUE. 

299 



END DO 

300 




301 



I F( INI TP.EQ. 1 ) THEN 

302 



INTERVALS = I ORDER - 1 

303 



ELSE 

304 



INTERVALS = I ORDER - IORDEROLD 

305 



I F( INTERVALS.LE.O) INTERVALS = NCHANNELS + INTERVALS 

306 



END IF 

307 




308 



TCUR = TCUR + INTERVALS * DT 

309 



IORDEROLD = I ORDER 

310 




311 



I LEO = ICHLLEO(ICHL) 

312 




313 



I F( ILEO.EQ.O) THEN 

314 




315 



J = 0 

316 



DONE = .FALSE. 

317 




318 



DO WHILE C .NOT. DONE) 

319 



j = j + 1 

320 



ICHLPR = ICHLPRSEQ(J) 

321 



IF(ICHLPR.EQ.ICHL) THEN 

322 



IF(J.LE.NLEOS) ILEO = J 

323 



DONE = .TRUE. 

324 



END IF 

325 



IFCJ.EQ. NCHANNELS) DONE = .TRUE. 

326 



END DO 

327 




328 



END IF 

329 




330 

C- 



331 

c 

In 

simulation mode, determine channel index and update current time. Also 

332 

c 

determine LEO satellite index. If channel is not currently assigned a LEO 

333 

c 

and 

is the highest priority free channel, then select an unassigned LEO in 

334 

c 

sequence, if available. Note: all channel assignments are performed in 

335 

c 

SUBROUTINE ASGNMFN . 

336 

Q- 



337 




338 


ELSE 

339 




340 



I ORDER = MOOdORDER, NCHANNELS) + 1 

341 



ICHL = ICHLORDERC IORDER) 

342 




343 



IF(INITP.EQ.O) TCUR = TCUR + DT 

344 



TCURM = TCUR/6D1 

345 



ITCURM = NINT(TCURM) 

346 



I F(DABS(TCURM- I TCURM ) .LT. ID -6) WRITE(*,80> ITCURM 

347 


80 

FORMAT ( I 7, ' MIN') 

348 




349 



IF(TCUR.GT.TSTOP) THEN 

350 



WRITE(*,90) 

351 


90 

FORMAT ( 1 END OF SIMULATION 1 ) 

352 



WRITE (20, 95) TSTOP 

353 


95 

FORMAT (/' TIME = • , F12.3, • SEC 1 , 8X, 'END OF SIMULATION') 

354 



STOP 

355 



END IF 

356 




357 



ILEO = I CHLLEOC ICHL ) 

358 




359 



I F( ILEO.EQ.O) THEN 

360 




361 



J = 0 

362 



DONE = .FALSE. 

363 




364 



DO WHILE (.NOT. DONE) 

365 



J = J + 1 

366 



ICHLPR = ICHLPRSEQ(J) 

367 



I F( 1 CHLLEOC ICHLPR) . EQ.O) THEN 

368 



I F( ICHLPR. EQ. ICHL) THEN 

369 



1=0 
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371 

372 

373 
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389 

390 

391 

392 

393 

394 
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398 

399 

400 

401 

402 

403 

404 

405 

406 

407 

408 


DO WHILE (.NOT. DONE) 

ILEOSEO = MOD( ILEOSEQ,NLEOS) + 1 
I F(LEOCHL( 1 LEOSEQ) .EG.0) THEN 
I LEO = ILEOSEO 
DONE = .TRUE. 

END IF 
1 = 1 + 1 

1 F( I .EQ.NLEOS) DONE = .TRUE. 

END DO 
END IF 

DONE = .TRUE. 

END IF 

I F( J.EQ.NCHANNELS) DONE = .TRUE. 

END DO 

END IF 

END IF 




C Proceed to Navigation Function. 



CALL NAVIGFN(HEO, LEO,NLEOS, ILEO,NCHANNEL$, ICHL,LEOCHL, 
1 ICHLLEO,TCUR) 


C 

C In real-time mode, get disc step commands. 
C 


I F(REALTIME) THEN 

ISTEPA = ISTEPASAVE 
ISTEPB = ISTEPBSAVE 
END IF 

INI TP = 0 

RETURN 

END 
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1 SUBROUTINE INV3X3(MAT) 

2 

3 REAL*8 MAT(3,3) ,TEMP(3,3) ,DET 

4 

5 DET = MATO , 1 )*MAT(2,2)*MAT(3,3) + MAT ( 1 ,2)*MAT (2,3)*MAT (3,1) + 

6 & MATO ,3)*MAT (2,1 )*MAT(3,2) - MAT(1,3)*MAT(2,2)*MAT(3,1) - 

7 & MAT(1,1)*MAT(2,3)*MAT<3,2) - MAT(1 ,2)*MAT(2, 1 )*MAT(3,3) 

8 

9 TEMPO , 1 )=MAT(2,2)*MAT(3,3)-MAT(2,3)*MAT(3,2) 

10 TEMP<1 ,2)=MAT(2,3)*MAT(3, 1 ) -MAT (2, 1 )*MAT(3,3) 

11 TEMPO ,3)=MAT(2, 1 )*MAT (3,2)-MAT(2,2)*MAT(3, 1 ) 

12 TEMPC2, 1 )=MAT(1 ,3)*MAT(3,2)-MAT(1 ,2)*MAT (3,3) 

13 TEMP(2,2)=MAT(1 , 1 )*MAT(3,3)-MAT(1 ,3)*MAT (3,1) 

14 TEMP(2,3)=MAT(1 ,2)*MAT(3, 1 )-MAT(1 , 1 )*MAT(3,2) 

15 TEMP(3, 1 )=MAT(1 ,2)*MAT (2, 3) -MAT ( 1 ,3)*MAT(2,2) 

16 TEMP(3,2)=MAT ( 1 ,3)*MAT(2, 1 )-MAT 0,1 )*MAT(2,3) 

17 TEMP(3,3)=MAT(1 , 1 )*MAT(2,2)-MAT ( 1 ,2)*MAT(2,1 ) 

18 

19 DO 1=1,3 

20 DO J=1 ,3 

21 MAT ( I , J)=TEMP(J , I )/DET 

22 END DO 

23 END DO 

24 

25 RETURN 

26 END 
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SUBROUTINE NAVIGFN (HEO,LEO,NLEOS, I LEO,NCHANNELS, ICHL, 
1 LEOCHL, ICHLLEO,TCUR) 


This routine simulates the Navigation Function, which consists of the 
Truth Generator, Scene Processor, and Navigation Processor. 

Prototype Version 1.0 Avtec Systems, Inc. August 1992 


Inputs: 

HEO 
LEO 
NLEOS 
I LEO 

NCHANNELS 

ICHL 

LEOCHL 

ICHLLEO 

TCUR 

IRATE 

REALTIME 

WFLAG 

PRDH 

PRDL 


= Geocentric-equatorial coordinates of HEO satellite 
= Geocentric-equatorial coordinates of LEO satellites 
= Number of LEO satellites 
= LEO satellite index 
= Number of disc channels 
= Channel index 
= LEO channel assignments 
= Channel LEO assignments 
= Current time 
= Tracking rate (MISCBLK) 

= Real-time flag (MISCBLK) 

= Write flag (MISCBLK) 

= Period of HEO satellite (ORBITBLK) 

S Periods of LEO satellites (ORBITBLK) 


IMPLICIT REAL*8 (A-H,0-Z) 

REAL*8 HEQ(6) , LE0<6,6) , HE0NAV(6) , LEONAV(6,6) 
REAL*8 AZS(6),ELS<6) 

INTEGERS LE0CHL(6), ICHLLEO(6) , INITLE0(6) 
LOGICAL ECLIPSE(6),OLDECLIPSE(6) 

CHARACTER*! DASH<73),ECLIND 
INCLUDE 'CIRCBLK.FCB' 

INCLUDE 'MISCBLK. FCB' 

INCLUDE 'ORBITBLK. FCB* 

DATA ECLIPSE /6*. FALSE./ 

DATA DASH /73*'-'/ 

DATA INITLEO /6*1/ 

DATA INIT /I/ 


C 

C Truth Generator simulates orbital dynamics of HEO and LEO satellites. 
C 


I F( ILEO.NE .0) THEN 

IF(. NOT. REALTIME) THEN 

CALL TRUTHGN(HEO, LEO, NLEOS, ILE0,TCUR) 

I F(WFLAG) THEN 

IF(INIT.EQ.I) UR I TE ( 11, 20 > DASH 
WRITE( 1 1 ,25) TCUR,(HEO(J),J=1,6) 
WRITEC 1 1 ,26) ILEO, (LEO( J , ILEO) , J=1 ,6) 
END IF 


END IF 

20 FORMAT (// ’ TRUTH GENERATOR ' ,4X, ' (KM) ' ,20X, »X ', 12X, 'Y' , 12X, ‘2 '/ 
1 20X, '(KM/SEC) *,16X,2HX',1 IX, 2HY',1 IX, 2H2'//' ',73AD 

25 FORMAT (// ' TIME =',F12.3,' SEC', 6X, 'HEO » ,3F13.3/35X,3F13.3) 

26 FORMAT (/29X, 'LEO' ,12, 1X,3F13.3/35X,3F13.3) 

C 

C Scene Processor determines FOV coordinates of LEO satellites. 

C 


IF(. NOT. REALTIME) THEN 
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137 


CALL SCENEPRCHEO, LEO,NLEOS, I LEO, N CHANNELS, TCUR, 

1 ECLIPSE, AZS, ELS) 

IF(INITLEOULEO).EQ.I) THEN 

I F(ECL IPSE< I LEO) ) WRITE(20,50) TCUR,ILEO 
I F( .NOT .ECLIPSEC I LEO) ) WRITE(20,55) TCUR,ILEO 
ELSE 

I F(ECLIPSE( ILEO) .AND. .NOT.OLDECLIPSE(ILEO)) 

1 WRITE(20,50) TCUR, I LEO 

I F ( .NOT . ECL I PSE( I LEO) .AND .OLDECLIPSE( ILEO)) 

1 WRITE(20,55) TCUR, ILEO 

END IF 

OLDECLIPSE(ILEO) = ECLIPSEC I LEO) 

I F(WFLAG) THEN 

I F( INIT.EQ. 1 ) WRITEC 12,60) (DASHC J) , J=1 ,69) 

ECLIND = • • 

I F(ECL IPSEC I LEO) ) ECLIND = ' E 1 

WR I TE ( 1 2 , 65 ) TCUR, ILEO, ECLIND, AZS( I LEO)*RAD,ELS( ILEO)*RAD 
END IF 

END IF 

50 FORMAT (/ 1 TIME =• , F12.3, » SEC* ,8X, 'LEO* , 12, 1 ECLIPSED') 

55 FORMATC/' TIME =',F12.3,' SEC ' ,8X, ' LEO* , 12, ' NOT ECLIPSED') 

60 FORMATC//' SCENE PROCESSOR 1 ,22X, ' ECL IPSE ', 5X, 'AZCDEG) ' , 

1 6X, 'ELCDEG) '// 1 ',69A1) 

65 FORMATC/' TIME =',F12.3,' SEC ' , 5X, ' LEO' , 12, A9, F15.5, F13.5) 


C Navigation Processor superimposes ephemeris errors. 
C 


IFC. NOT. REALTIME) THEN 

CALL NAVIGPRCHEO, LEO, NLEOS, ILEO, TCUR, HEONAV, LEONAV) 

IFCWFLAG) THEN 

IF(INIT.EQ.I) WRITE Cl 3, 80) DASH 
WRITEC 13,25) TCUR , CHEONAVC J) , J=1 ,6) 

WRITEC 13,26) ILEO, CLEONAVC J, ILEO), J=1 ,6) 

END IF 

END IF 

80 FORMATC//' NAVIGATION PROCESSOR CKM) ' , 16X, 'X ' , 12X, ' Y ' , 1 2X, ' Z 1 
1 /24X, ' C KM/SEC) ' , 12X, 2HX 1 , 1 1X,2HY 1 , 1 IX, 2HZ '// ' ',73A1> 


INI TLEOC I LEO) = 0 
I NIT = 0 

END IF 


C 

C Proceed to Assignment Function. 
C 


CALL ASGNMFNCHEONAV, LEONAV, ECLIPSE, AZS, ELS, ILEO, ICHL,LEOCHL, 
1 ICHLLEO, TCUR ) 


RETURN 

END 


FILE: D:\TEMP\NAVIGPR.FOR 

Size: 2369 Edited: 8-12-92, 9:50p Printed: 11-17-92, 2:30p 


Page: C162 


1 

2 

3 

4 

5 

6 

7 

8 
9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 
21 
22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

32 

33 

34 

35 

36 

37 

38 

39 

40 

41 

42 

43 

44 

45 

46 

47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 
61 
62 

63 

64 

65 

66 

67 

68 

69 

70 

71 

72 

73 


C 


C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


SUBROUTINE NAVIGPR (HEO, LEO, NLEOS, I LEO, TCUR, HEONAV, LEONAV) 

This routine simulates the Navigation Processor, which superimposes 
ephemeris errors on the true satellite positions and velocities. 

Prototype Version 1.0 Avtec Systems, Inc. August 1992 

Entry points: 

NAVIGPR Initialization is performed in first call 
NAVIGPR 2 Initialization is not performed 


Inputs: 

HEO = Geocentric-equatorial coordinates of HEO satellite 

LEO = Geocentric-equatorial coordinates of LEO satellites 

NLEOS = Number of LEO satellites 

ILEO = LEO satellite index 

TCUR = Current time 

PRDH = Period of HEO orbit (ORBITBLK) 

PRDL = Periods of LEO orbits (ORBITBLK) 

Outputs: 

HEONAV = Coordinates of HEO satellite including ephemeris errors 

LEONAV(ILEO) = Coordinates of LEO satellite including ephemeris errors 


IMPLICIT REAL*8 (A-H,0-Z) 

REAL*8 HEQ(6) , LE0(6,6) , HE0NAV(6) , LE0NAV(6,6) 
REAL*8 HPHS(3) , LPHS(3, 6) , LFREQ(6) 

INCLUDE 'CIRCBLK.FCB' 

INCLUDE 'ORBITBLK. FCB' 

DATA INIT /I/ 

IF( INIT.EQ.1) THEN 

DO J=1,3 

CALL RNDM(UNIF) 

HPHS(J) = TWOPI *UN I F 
DO 1=1 , NLEOS 

CALL RNDM(UNIF) 

LPHS( J, I ) = TWOPI W UNI F 
END DO 
END DO 

HFREQ = TWOPI /PRDH 

DO 1=1, NLEOS 

LFREQ(I) = TWOPI /PRDL( I ) 

END DO 

INIT = 0 

END IF 


C 

ENTRY NAVIGPR2 (HEO, LEO, I LEO, TCUR, HEONAV, LEONAV) 



TEMPH = HFREQ*TCUR 
TEMPL = LFREQ( ILE0)*TCUR 

DO J=1 ,3 

ARG = TEMPH+HPHS(J) 

HEONAV(J) = HEO(J) + EPHH*DSIN(ARG) 

HEONAVC J+3) = HEO(J+3) + EPHH*HFREQ*DCOS(ARG) 
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74 

ARG = TEMPL+LPHS( J , I LEO) 

75 

LEONAVC J, ILEO) = 

LEO( J, ILEO) + EPHL*DSIN(ARG) 

76 

LEONAV(J+3 # ILEO) 

= LEO( J+3, 1 LEO) + EPHL*LFREQ(ILEO)*DCOS(ARG) 

77 



78 

END DO 


79 



80 

RETURN 


81 

END 
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1 C 

2 

3 PROGRAM OMA 

4 

5 C Control software simulation for the Optical Multiple Access (OMA) system. 

6 C (compatible with Microsoft FORTRAN Version 5.0 and VAX FORTRAN V5.5) 

7 C 

8 C This main program simulates the real-time executive program. 

9 C 

10 C 

11 C Prototype Version 1.0 Avtec Systems, Inc. August 1992 

12 C 

13 C 

14 C Inputs and outputs: see SUBROUTINE INTRFACE 

15 C 

16 C 

17 

18 REAL*8 U,V 

19 INTEGERS ICHANNEL 

20 INTEGERS ISTEPA, ISTEPB 

21 LOGICAL REALTIME, INTRACK 

22 

23 DATA REALTIME /.FALSE./ 

24 

25 C 

26 C 

27 C In simulation mode: 

28 C 

29 C REALTIME is false. 

30 C ICHANNEL, INTRACK, U, V, ISTEPA, ISTEPB are not used. 

31 C 

32 C 

33 

34 CALL INIT(REALTIME) 

35 

36 10 CALL POSITION( ICHANNEL, INTRACK, U,V, ISTEPA, ISTEPB) 

37 GO TO 10 

38 

39 


END 
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C 

SUBROUTINE OF I T(HI NTG, LI NTG,NLEO$, T1 ,DT INTG) 

C This routine fits a quadratic function of time to each position coordinate 
C and velocity component using 3 points. 

C 

C Prototype Version 1.0 Avtec Systems, Inc. August 1992 
C 

C Inputs: 

C 

C HINTG = 3 Runge-Kutta integration points of HEO satellite state 

C LINTG = 3 Runge-Kutta integration points of LEO satellite states 

C NLEOS = Number of LEO satellites 

C T1 = Time of first integration point 

C DTINTG = Integration time interval 

C 

C 


IMPLICIT REAL*8 (A-H,0-Z) 

REAL*8 HE0(6) , LE0(6,6),HINTG(6,3),LINTG(6,6,3) 
REAL*8 TMAT (3,3),HC0EFF(6,3),LC0EFF(6,6,3) 

TMAT (1,2) = T1 

TMAT (2, 2) = T1 + DTINTG 

TMAT<3,2) = T1 + 2*DT INTG 


DO J=1 ,3 

TMAT ( J , 1 ) = IDO 
TMAT ( J ,3) = TMAT ( J,2)**2 
END DO 

CALL INV3X3(TMAT) 

DO I COORD=1 ,6 
DO I TERM=1 ,3 

TEMP = 0 
DO J=1 ,3 

TEMP = TEMP + HINTGC ICOORD, J )*TMAT( I TERM, J) 

END DO 

HCOEFF( I COORD, ITERM) = TEMP 

DO I =1 r NLEOS 
TEMP = 0 
DO J=1 ,3 

TEMP = TEMP + L I NTG ( I COORD, I , J)*TMAT( ITERM, J ) 
END DO 

LCOE F F ( I COORD ,1,1 TERM ) = TEMP 
END DO 

END DO 
END DO 

RETURN 


C 

ENTRY QVAL(TCUR, I LEO, HEO, LEO) 

C Evaluate quadratic functions of position coordinates and velocity 
C components. 

C 

C Inputs: 

C 

C TCUR = Current time 

C I LEO = LEO satellite index 

C 

C Outputs: 

C 

C HEO = Geocentric -equatorial coordinates of HEO satellite 

C LEO = Geocentric-equatorial coordinates of LEO satellites 
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74 C 

75 C 

76 

77 TCURSO = TCUR**2 

78 

79 DO I COORD=1 ,6 

80 

81 HEO(ICOORD) = HCOEFFC ICOORD, 1 ) + HCOEFF( ICOORD, 2)*TCUR + 

82 1 HCOEFFC I COORD, 3 )*T CUR SO 

83 

84 LEOC ICOORD, ILEO) = LCOEFFC ICOORD , I LEO, 1 ) + 

85 1 LCOEFFC ICOORD, I LEO,2)*TCUR + LCOEFFC ICOORD, ILEO, 3)*TCURSQ 

86 

87 END DO 

88 

89 RETURN 

90 END 
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1 C 

2 

3 SUBROUTINE RNDM (Z) 

4 

5 C GENERATES RANDOM NUMBERS HAVING A UNIFORM DISTRIBUTION, USING THE 

6 C MULTIPLICATIVE CONGRUENT I AL METHOD 

7 C 

8 C REFERENCE: 

9 C B. CARNAHAN, H . A. LUTHER AND J.D. WILKES, "APPLIED NUMERICAL METHODS" 

10 C JOHN WILEY & SONS, NEW YORK, NY, 1969, pp. 545-549. 

11 C 

12 C 

13 

14 IMPLICIT REAL*8 (A-H,0-Z) 

15 INTEGER*4 A,M,X 

16 

17 DATA I /I/ 

18 

19 I F ( I .EQ. 1) THEN 

20 1=0 

21 M = 1048576 ! 2**20 

II r.%«387 ‘SEED 

24 A = 1027 ! 2** 10+3 

25 END I F 

26 

27 X = MOO(A*X,M) 

28 Z = X/FH 

29 RETURN 

30 END 
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1 

2 

3 SUBROUTINE RUK(X,DT ,XNEW) 

4 

5 C Fourth order Runge-Kutta integrator. 

6 C 

7 C Courtesy of Bob Dasenbrock of NRL. Modified for OMA. 

8 C 

9 C Inputs: 

10 C 

11 c X( 1,2,3) = current satellite position in geocentric coordinates (km) 

12 C X(4,5,6) = current satellite velocity in geocentric coordinates (km/sec) 

13 C DT = propagation time interval (sec) 

14 C 

15 C Outputs: 

16 C 

17 C XNEW( 1,2,3) = satellite position propagated ahead DT sec 

18 C XNEW(4,5,6) = satellite velocity propagated ahead DT sec 

19 C 

20 

21 

22 IMPLICIT REAL*8 (A-H,0-Z) 

23 DIMENSION D(6), F(6),U(6) ,X(6),XNEW(6) 

24 

25 CALL DFQ(X,D,DT) 

26 

27 DO K=1 ,6 

28 U(K)=X(K)+0.5D0*D<IO 

29 END DO 

30 

31 CALL DFQ(U, F,DT) 

32 

33 DO K=1 ,6 

34 D(K)=D(K)+2 .0D0*F(K) 

35 U(IC)=X(IC)+0.5D0*F(K) 

36 END DO 

37 

38 CALL DFQ(U, F,DT) 

39 

40 DO K=1 ,6 

41 D(K)=D(K)+2.0D0*F(K) 

42 U(K)=X(K)+F(K) 

43 END DO 

44 

45 CALL DF0(U,F,DT) 

46 

47 DO K=1 ,6 

48 XNEW(K)=X(K)+(D(K)+F(K) )/6.0D0 

49 END DO 

50 

51 RETURN 

52 END 
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C 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c- 


SUBROUT I NE SCANGN < ILEO, ICHL, MODE, SCANRES, TCUR, AZSCAN,ELSCAN) 
Scan Generator implements acquisition and reacquisition patterns. 
Prototype Version 1.0 Avtec Systems, Inc. August 1992 


Inputs: 


I LEO 

ICHL 

MODE 

SCANRES 

BEAMW 

TCUR 

TSMALLSCAN 

WFLAG 


LEO satellite index 
Channel index 
Channel modes 
Scan reset flags 
HEO beamwidth 
Current time 
Earliest time for small 
Write flag (MISCBLK) 


scan pattern (ATTBLK) 


Outputs: 


AZSCAN(ILEO) = Azimuth coordinate of scan position 
ELSCAN(ILEO) = Elevation coordinate of scan position 
MODE(ICHL) = Channel mode 


IMPLICIT REAL*8 (A-H,0-Z) 

REAL*8 AZSCAN(6) , EL SCAN (6) 

INTEGER*2 IP0SIT(6), ICOUNT(6) , IS1ZE<6), ISIZE2(6), ISIGN<6) 
LOGICAL SCANRESC6) , SMALLSCAN 
CHARACTERS M00E<6) 

INCLUDE 'ATTBLK. FCB' 

INCLUDE ‘ FOVBLK. FCB' 

INCLUDE 'MISCBLK. FCB' 

DATA I SQUARE /1 089/ 

DATA I SMALLSQUARE /121/ 

DATA SMALLSCAN /.FALSE./ 

DATA I POSIT /6*0/ 

DATA INIT /I/ 

IF(INIT.EQ.I) THEN 
HALFBEAM = BEAMU/2 
QRTRBEAM = BEAMW/4 
INIT = 0 
END IF 

IF(. NOT. SMALLSCAN .AND. TCUR .GE .TSMALLSCAN) THEN 
I SQUARE = I SMALLSQUARE 
SMALLSCAN - .TRUE. 

END IF 


! Number of beams in square pattern 
! Number of beams in small square pattern 


C 

C If the scan pattern was previously just finished, repeat it. 
C 


I F C IPOS IT ( I LEO) . GE . I SQUARE .AND. .NOT .SCANRES< ILEO)> THEN 

SCANRESC I LEO) = .TRUE. 

I F(WFLAG) WRI TE( 15 ,20) 

20 F0RMATC17X, 'REPEAT SCAN') 

WRITE(20,21 ) TCUR, ICHL 

21 FORMAT (/ 1 TIME =',F12.3,' SEC’ ,8X, 'CHANNEL ', 12, ' REPEAT SCAN') 

I F(MOOE( I CHL).EQ. 'ACQUISITION* ) THEN 
MODE (ICHL) = 'SLEW TO ACQ' 

ELSE 

MOOE(ICHL) = 'SLEW TO REACQ' 

END IF 

I F(WFLAG) WRITE(15,23) MOOE(ICHL) 

23 FORMAT (A16) 
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74 

75 

76 

77 C 



END IF 


If scan reset flag is true, initialize the scan pattern. 
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C 

SUBROUTINE SCENEPR (HEO, LEO, NLEOS, I LEO, NCHANNELS,TCUR, 

1 ECLIPSE, A2S, ELS) 

C The Scene Processor computes the azimuth & elevation of a received 
C LEO beam center, including the effects of attitude errors. 

C 

C Prototype Version 1.0 Avtec Systems, Inc. August 1992 
C 

C Inputs: 

C 

C HEO = Geocentric-equatorial coordinates of HEO satellite 

C LEO = Geocentric-equatorial coordinates of LEO satellites 

C NLEOS = Number of LEO satellites 

C I LEO = LEO satellite index 

C NCHANNELS = Number of disc channels 

C TCUR = Current time 

C IRATE = Tracking rate (MISCBLK) 

C PRDH = Period of HEO orbit (ORBITBLK) 

C 

C Outputs: 

C 

C ECLIPSEC I LEO) = True if LEO is eclipsed by the earth 

C AZS(ILEO) = Azimuth in HEO FOV 

C ELS(ILEO) = Elevation in HEO FOV 

C 

C 


IMPLICIT REAL*8 (A-H,0-2) 

REAL*8 HEO(6) , LE0(6,6) , AZS(6) , ELS(6) , AZAHEADC6) , ELAHEAD(6) 

LOGICAL ECLIPSE (6) , FINDADJT,DONE 

INCLUDE ' ATTBLK. FCB 1 

INCLUDE 1 CIRCBLK. FCB 1 

INCLUDE 'MISCBLK. FCB 1 

INCLUDE 'ORBITBLK. FCB* 


DATA ATTRP /ID-3/ 

DATA ATTRPAD J /2.5D-4/ 
DATA ATTY /3D-3/ 

DATA ATTYADJ /7.5D-4/ 
DATA VIBSIGMA /1.585D-5/ 
DATA VIBBANDW /1D0/ 


! Slow roll and pitch variation (rad) 

! Adjusted slow roll and pitch variation (rad) 
! Slow yaw variation (rad) 

! Adjusted slow yaw variation (rad) 

! Standard deviation of vibration (rad) 

! 3 dB bandwidth of vibration PSD (Hz) 


DATA FINDADJT /.FALSE./ 

DATA ROLADJT /1D30/, PCHADJT /1D3Q/, YAWADJT /1D30/ 
DATA OLDVIBROL /0D0/, OLDVIBPCH /0D0/, OLDVIBYAW /0D0/ 
DATA INI T /I/ 


IF(INIT.EQ.I) THEN 

Cl = TWOPI / (PRDH/2) 

C2 = 1 - DEXP( - TWOP I*VI BBANDW/( IRATE*NCHANNELS) ) ! All channels called 

GVAR = (2-C2)/C2 * VIBSIGMA**2 
CALL RNDM(UNIF) 

ROLPHS = TVOPinJNIF 
CALL RNDM(UNIF) 

PCHPHS = TWOPI*UNI F 
CALL RNDM(UNIF) 

YAWPHS = TWOPI*UNIF 

I F(NLEOS.GE .4 .AND. NCHANNELS. GE .4) FINDADJT = .TRUE. 

IN I T = 0 
END IF 


C 

C Generate random vibrations in roll, pitch and yaw. 

C - - 


VIBROL = OLDVIBROL ♦ (GAUSS(0D0, GVAR) -OLDVIBROL) * C2 
VIBPCH = OLDVIBPCH ♦ (GAUSS(0D0, GVAR)-OLDVI BPCH) * C2 
VIBYAW = OLDVIBYAW + (GAUS$(0D0, GVAR)-OLDVI BYAW) * C2 


C 

C If ^acquisitions is at least 2 (and there are at least 4 LEOs and channels) 
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determine when to adjust variations in roll, pitch and yaw. 


TEMP = C1*TCUR 

I F( FINDAD JT .AND. NACQS.GE.2) THEN 

ROLADJT = - ROLPHS 

DONE = .FALSE. 

DO WHILE (.NOT. DONE) 

ROLADJT = ROLADJT + PI 
I F( ROLADJT .GE .TEMP) DONE = .TRUE. 

END DO 

PCHADJT = - PCHPHS 

DONE = .FALSE. 

DO WHILE (.NOT. DONE) 

PCHADJT = PCHADJT + PI 
I F (PCHADJT ,GE .TEMP) DONE = .TRUE. 

END DO 

YAWADJT = - YAWPHS 

DONE = .FALSE. 

DO WHILE (.NOT. DONE) 

YAWADJT = YAWADJT + PI 
I F( YAWADJT .GE .TEMP) DONE = .TRUE. 

END DO 

TSMALLSCAN = DMAX1 (ROLADJT, PCHADJT, YAWADJT) / Cl 

FINDADJT = .FALSE. 

END IF 


Determine total errors in roll, pitch and yaw. If time is large enough, 
adjust attitude variations. 


IF(TEMP.LT. ROLADJT) THEN 

ROLERR = ATTRP * DSIN(TEMP+ROLPHS) + VIBROL 
ELSE 

ROLERR = ATTRPAD J * DSIN(TEMP+ROLPHS) + VIBROL 
END IF 

IF(TEMP.LT. PCHADJT) THEN 

PCHERR = ATTRP * DSIN(TEMP+PCHPHS) + VIBPCH 
ELSE 

PCHERR = ATTRPADJ * DSIN(TEMP+PCHPH$) + VIBPCH 
END IF 

IF(TEMP.LT. YAWADJT) THEN 

YAWERR = ATTY * DS I N(TEMP+ YAWPHS) + VIBYAW 
ELSE 

YAWERR = ATTYADJ * DSINCTEMP+YAWPHS) + VIBYAW 
END IF 


Calculate azimuth and elevation of received LEO beam center. 


CALL XYZAZEL(HEO, LEO, I LEO, *T ', ‘R ', ECLIPSE, AZS, ELS, AZAHEAD,ELAHEAD) 


Include effects of attitude errors on azimuth and elevation. 


AZTEMP = AZS(ILEO) + PCHERR 
ELTEMP = ELS(ILEO) + ROLERR 

SINY = DSIN(YAWERR) 

COSY = DCOS(YAWERR) 

AZS(ILEO) = AZTEMP*COSY-ELTEMP*SINY 
ELS(ILEO) = AZTEMP*S I NY+ELTEMP*COSY 
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148 



149 

OLDVIBROL 

= VIBROL 

150 

OLDVIBPCH 

= VIBPCH 

151 

OLDVIBYAW 

= VIBYAW 

152 



153 

RETURN 


154 

END 
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C 


SUBROUTINE TRUTHGN ( HEO, LEO,NLEOS, I LEO,TCUR) 


C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c- 


Truth Generator simulates orbital dynamics of the HEO and LEO satellites. 

Prototype Version 1.0 Avtec Systems, Inc. August 1992 

Inputs: 

HEO = Geocentric-equatorial coordinates of HEO satellite 
LEO = Geocentric-equatorial coordinates of LEO satellites 
NLEOS = Number of LEO satellites 
I LEO = LEO satellite index 
TCUR = Current time 

Outputs: 

HEO = Updated geocentric-equatorial coordinates of HEO satellite 
LEO = Updated geocentric-equatorial coordinates of LEO satellites 


IMPLICIT REALMS <A-H,0-Z) 

REAL*8 HEO(6), LEO(6, 6), HINTG(6,3) , LINTG(6,6,3) 
DATA DTINTG /101/ 

DATA IN I T tV 


C 

C If initializing, propagate orbits using Runge-Kutta integration to obtain 
C three points for quadratic fit. 

C 


I F( INIT.EQ. 1 ) THEN 

CALL C0PYVEC(HE0,6, HINTGC 1,1)) 

CALL RUKCHEO, DTINTG, HINTGC1, 2)) 

CALL RUK(HINTG(1 ,2),DTINTG,HINTG(1,3)> 

DO 1=1, NLEOS 

CALL COPYVECC LEO< 1 , I ) , 6, L I NTG( 1,1,1)) 

CALL RUK(LEO( 1 , I ) , DTINTG, L INTG(1 , I ,2)) 

CALL RUK(LINTG(1 , I ,2) ,DT INTG, LINTGC 1,1,3)) 
END DO 

CALL OF I T( HINTG, LINTG, NLEOS, 000, DTINTG) 

TPROP = DTINTG 
INIT = 0 


C 

C If necessary to obtain a later point for quadratic fit, propagate orbits 
C further using Runge-Kutta integration. 

C 


ELSE IFCTCUR.GE. TPROP) THEN 

CALL COPYVECC H I NTG( 1,2),6,HINTG(1,1)) 

CALL COPYVEC(HINTG( 1,3), 6, HINTGC 1,2)) 

CALL RUKC HINTGC 1,2), DTINTG, HINTGC 1,3)) 

DO 1=1, NLEOS 

CALL COPYVECC LINTGC 1 f I ,2),6, LINTGC 1 , I , 1 ) ) 
CALL COPYVECC LINTGC 1,1, 3), 6, LINTGC 1, 1,2)) 
CALL RUKC LINTGC 1,1, 2), DTINTG, LINTGC 1,1, 3)) 
END DO 

CALL OF ITCH INTG, LINTG, NLEOS, TPROP, DTINTG) 
TPROP = TPROP + DTINTG 

END IF 


C 

C Evaluate quadratic functions to obtain satellite coordinates between 
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74 C 

integration points. 

75 C- - 


76 


77 

CALL QVALCTCUR, I LEO, HEO, LEO) 

78 


79 

RETURN 

80 

END 


'OOO-gO'tJl-P'-WM 
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1 SUBROUTINE UNIT(V) 

REAL*8 V(3) , VLEN 

VLEN=DSQRT(V(1)**2+V(2)**2+V(3)**2) 
I F(VLEN.EO.O) STOP 113 
V( 1 )=V( 1 J/VLEN 
V(2)=V(2)/VLEN 
V(3)=V(3)/VLEN 
RETURN 
END 



wi w r\j 


FILE: 

Size: 


1 
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REAL*8 FUNCTION VLEN(V) 

REAL*8 V(3) 

VLEN=DSQRT(V(1)**2+V(2)**2+V<3>**2) 

RETURN 

END 
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1 DOUBLE PRECISION FUNCTION XKEP (ECC,XM,TOL) 

2 C SOLVES KEPLER'S EOUATION "XM=XKEP-ECC*SIN(XKEP)" 

3 C SOLVES FOR "XKEP" IN RADIANS GIVEN "XM" AND "ECC" 

4 IMPLICIT REAL*8 (A-H,0-Z) 

5 EOLD=XM 

6 DO 10 K=1 , 100 

7 SEC=DSIN(EOLD)*ECC 

8 CEC=DCOS ( EOLD )*ECC 

9 ENEW=(XM+SEC-EOLD*CEC)/(1 .0D0-CEC) 

10 DE=DABS(ENEW-EOLD) 

11 IF (DE.LE.TOL) GO TO 20 

12 10 EOLD=ENEU 

13 WRITE(*, 100) 

14 100 FORMAT (10X, 1 ** KEPLERS EOUATION DID NOT CONVERGE **') 

15 STOP 

16 20 XKEP=ENEW 

17 RETURN 

18 END 
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1 C 

2 

3 SUBROUTINE XYZAZEL (HEO, LEO, ILEO, COORD, BEAM, ECLIPSE, AZ, EL, 


4 

5 


1 


AZAHEAD , ELAHEAD ) 


6 

C 

This routine transforms LEO X.Y.Z to HEO FOV coordinates AZ.EL. 

7 

C 





8 

C 

Prototype Version 1.0 Avtec Systems, Inc. 

August 1992 

9 

C 





10 

c 

Inputs: 




11 

c 





12 

c 

HEO 


Geocentric-equatorial coordinates of 

HEO satel l i te 

13 

c 

LEO 

= 

Geocentric-equatorial coordinates of 

LEO satellites 

14 

c 

ILEO 

= 

LEO satellite index 


15 

c 

COORD 

= 

Coord source: 1 T • (Truth Generator) < 

or 1 N 1 (Navigation Processor) 

16 

c 

BEAM 

= 

Beam direction: 'R 1 (receive) or 'T 1 

(transmit) 

17 

c 





18 

c 

Outputs: 




19 

c 






20 C ECLIPSE(ILEO) = Eclipse flag 

21 C AZ(ILEO) = Azimuth 

22 C EL(ILEO) = Elevation 

23 C AZAHEAD(ILEO) = Azimuth point-ahead angle 

24 C ELAHEA0( ILEO) = Elevation point-ahead angle 

25 C 

26 C 

27 

28 IMPLICIT REAL*8 (A-H,0-Z) 

29 REAL*8 HE0(6),LE0(6,6),AZ(6),EL(6),AZAHEAD(6),ELAHEAD(6> 

30 REAL*8 AZVEC(3),ELVEC(3),DOWN(3),TOLEO(3) 

31 LOGICAL ECL1PSE16) 

32 CHARACTERS COORD, BEAM 

33 INCLUDE 'ORBITBLK.FCB' 

34 

35 DATA C /2. 9979245805/ ! Speed of light (km/sec) 

36 DATA RE /6.378145D3/ ! Earth radius (km) 

37 DATA INIT /I/ 

38 

39 IF(INIT.EQ.I) THEN 

40 RESO = RE**2 

41 RSQ = (RE+DSQRT(3D0)*EPHL)**2 

42 INIT = 0 

43 END I F 

44 

45 IFfBEAM .EQ. *R • ) SIGN = -1 

46 I F(BEAM .EQ. 'T') SIGN = 1 

47 

48 DO J=1 ,3 

49 DOWN(J) = -HEO(J) 

50 AZVEC(J) = HEOCJ+3) ! Circular orbit 

51 END DO 

52 

53 CALL UN IT (DOWN) 

54 CALL UNIT(AZVEC) 

55 CALL CROSS (AZVEC , DOWN , ELVEC ) 

56 

57 RHEO = VLEN(HEO) 

58 IF(COORD.EO. • T 1 ) RHORIZ = DSQRT(RHEO**2-RESQ) 

59 IF(COORD.EQ.'N') RHORIZ = DSQRT ( RHEO**2 - RSQ ) 

60 COSTHRES = RHORIZ/RHEO 

61 

62 DO J=1 ,3 

63 TOLEO(J) = LEO(J.ILEO) - HEO(J) 

64 END DO 

65 

66 RTOLEO = VLEN(TOLEO) 

67 CALL UNIT(TOLEO) 

68 

69 AZCOMP = DOT(TOLEO, AZVEC) 

70 ELCOMP = DOT(TOLEO, ELVEC) 

71 DNCOMP = DOT (TOLEO, DOWN) 

72 IF(DNCOMP.LE.O) STOP 117 

73 
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74 I F(DNCOMP.GE .COSTHRES .AND. RT0LE0. GE .RHORIZ) THEN 

75 ECLIPSE(ILEO) = .TRUE. 

76 ELSE 

77 ECLIPSE(ILEO) = .FALSE. 

78 END I F 

79 

80 AZTEMP = DATAN(AZCOMP/DNCOMP) 

81 ELTEHP = DATAN(ELCOMP/DNCOMP) 

82 

83 TPROP = DSQRT ( (HEO( 1 )-LEO( 1 , 1 LEO) )**2 + <HEO(2)-LEO<2, ILEO))**2 

84 1 ♦ (HEO(3)-LEO(3, 1 LEO) )**2) / C * SIGN 

85 

86 DO J=1,3 

87 TOLEO(J) = LEO(J,ILEO)+TPROP*(LEO(J+3 # ILEO)-HEO(J+3))-HEO(J) 

88 END DO 

89 

90 CALL UNIT(TOLEO) 

91 

92 AZCOMP = DOT(TOLEO, AZVEC) 

93 ELCOMP = DOT(TOLEO,ELVEC) 

94 DNCOMP = DOT (TOLEO, DOWN) 

95 IF(DNCOMP.LE.O) STOP 117 

96 

97 AZ(ILEO) = DATAN(AZCOMP/DNCOMP) 

98 EL(ILEO) = DATAN(ELCOMP/DNCOMP) 

99 

100 AZAHEADC I LEO) = 2 * (AZ(ILEO) - AZTEMP) * SIGN 

101 ELAHEAD( I LEO) = 2 * (EL(ILEO) - ELTEMP) * SIGN 

102 

103 RETURN 

104 END 





